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APPENDIX  C 


tips  SOFTWARE  SOURCE  CODE 

Appendix  C  conuiiu  (ource  code  for  the  tiPS  loftwere.  The  following  filet  ere  included  end  appeer  in  the  order  ehown: 


NFS  dirKto(>  file*  • 

ORBMECHl  directory  fiks  • 

INC  directory  files  • 

dif_data.c 

amttrix.c 

com_port.h 

dif_ploi.c 

bgprop.c 

comjjori.inc 

f_tnd  _g.c 

cowetl.c 

const  .h 

kfUter.c 

der.c 

edit.h 

menuplot.c 

geffl9.c 

edit_n.h 

npe-c 

gctien.c 

emm.h 

npe.h 

gotpot.c 

keyt.h 

np)>_dap.c 

ieri.h 

np»_it'.h 

np>_edit.c 

itowgsM.c 

orbmechl  .h 

npt_filt.c 

jacetm.c 

packet  .h 

iipt_inSO.c 

jacdat.c 

pktjf.h 

np(_ni50.h 

m50mp.c 

twap.h 

nps_none.c 

rk4.c 

tant_pkt.h 

npi_plol.c 

mpd.c 

timet  .h 

nps_prad.c 

mpmSO.c 

timet.inc 

pyjlate.c 

util.c 

lypet.h 

py_plot.c 

util.h 

vector.h 

rv_date.c 

rv_plot.c 

UTIL  directory  files  • 

TEST  directory  files  • 

edit.c 

comjxrx.c 

NPS_SIM  dtrectory  Hex  ■ 

edit_fld.c 

emmjest.c 

gcom_com.c 

edit_rt.c 

les.c 

gcom_dev,c 

cmin^cons.c 

map_raw.c 

gdiek.c 

einm_lowa.asm 

orb.c 

gnone.c 

efnm_nup.c 

tant_vec.c 

npt_nuin.c 

emni_mapm.c 

tansdump.c 

Kom.c 

key_get.aun 

test.c 

Koni_oId.c 

key_ini9.a«n 

iest_com.c 

fdiak.c 

twap_d.aMn 

teiit_dev.c 

tdisk_2.c 

twap_f.aim 

test_vec.c 

tim.c 

twap_i.aini 

testl.c 

tim-h 

tdbljims.atm 

tettZ.c 

tmem.c 

tdbl_itr.aim 

vect_old.c 

iprop.c 

1hiiH_dbl.asin 

vmode.c 

ipropdik.c 

thim_str.atin 

timer  .atm 

TANS  directory  files  - 

COM  dinctoiy  files  • 

VJ2000.C 

(  not  included  } 

com_iiitt.«tin 

v__m50.c 

coni_inic.c 

v_matrix.c 

TANS_SIM  directory  files 

ort>_file.c 

v_quat.c 

( not  included  ) 

ofl>_pla.c 

v_fvbar.c 

otb_poit.c 

v_vector.c 

Borland  C-t-  +  Makefile- 

tent _pkt.c 

makefile 

tantfile.c 

tanapoft.c 

tanipkt2.c 


dlf  data.c 


4^1ude  <aIloc.b> 
jKnclude  <mein.h> 
iKnclude  <io.h> 


iKncliide  <fcntl.h> 
iKncIiide  <imUh.h> 

finclude  "ops-h” 

♦ - */ 

int  nps_diffplot_data_init(Nps_dif}iplot_info  *this, 

ushort  iiiax_meiii,  ushort  config  mem,  Emm_mfo  '*%mm) 

{ 

int  handle; 

Nps_log_fiIe_header  header; 

/* - 

Try  to  get  EMM  memoiy  first,  and  64K  of  it.  Otherwise  use  normal  mem. 

*! 

if  (emm_info_exists(emffl))  emm_construct_new(&this->emm,  emm,  4); 

if  (emm  exists(&this->emm)) 

{ 

char  iuune[10]; 

memcpy(name,  this- >  log_fiie_name,  8); 
enim_name_set(&this->emm,  name); 

this->ring_max  »  Oxffff  /  sizeofiDiff  vector); 
max_mem  =  sizeof(Diff_vector)  "■  this->ring_max; 
this->ring_buffer  =  MK_FP(emm'>phys.segments[0],  0); 

emm  nup  multi(&this->emm,  EMM_phys_page,  4,  emm->map_0123); 

} 


/* - 

Ring_max  may  already  be  initialized,  if  not  then  conqnite  it  from  the 
*  max  mem  argument.  Allocate  the  ring  buffer. 

♦/ 

else 

{ 

if  (config_mem  >  1024) 

this->ring_max  »  config_mem  /  sizeof(Diff_vector); 

if  (this->ring_nuuc  sb  O) 

this->ring_max  b  max_mem  /  sizeof(Diff_vector); 


ieoesalon  For  ) 

HTIS  ORAW 

a" 

DTIC  T.SiB 

□ 

UnanDC'.incsd 

□ 

icatlon — 

By - - - 

i-’Silf'.MlltT  Codea 


dif  dat«.c 
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this->ring_buffer  «  nialloc(iiuui_inem  »  8izeof(Diff_vector)  this->ring_inax); 
if  (this->ring_buffer  ==  NULL)  return  NO; 


/* - 

Clear  the  ring  buffer,  and  try  to  c^reo  my  log-file. 

*! 

memset(dus->ring_buffer,  0,  inax_mem); 

if  ((handle  *  opeo(this*>log_flle_naine,  0_RD0NLY|0_BINARY))  <  0)  return  YES; 

I* - 

Read  and  verify  the  log-file  header  pattern,  then  fill  my  ring  buffer 
from  the  file.  I  assume  all  sanqiles  are  in  time  order  in  the  file. 

*/ 

if  (read(handle,  &header,  sizeof(header))  —  —  sizeof(header) 

&&.  memcmp(&header,  this- >  log  file_hdr,  sizeof(header))  »=  0) 

{ 

this->next_sample  =  read(handle,  this->ring_buffer,  max  mem)  /  sizeof(Diff_vector); 
this->prev_sample  —  this- >  next_sample  -  1; 

if  (this- >  next  sample  >=  this- >  ring  nux) 

{ 

this->next_sample  =  0; 
this- >  ring  full  —  YES; 

} 

else  if  (this->next_sample  <=  0) 

this->prev_sample  =  this->next_sample  =  0; 

this- >  begin  time  =  this- >ring_buffer[0].  time; 

} 

close(handle); 
return  YES; 


♦ - -  - */ 

void  nps  diffplot  data  stop(Nps  diflplot  info  "this) 

{ 

if  (emm_exists(&this->emm)) 
emm_destroy(&this-  >  emm); 

} 

void  nps  diffylot_data  save(Nps  diffplot  info  "this) 

{  " 


int  handle; 
ushort  size; 


di£  data.c 


dl£  data.c 


/* - 

Tfy  to  open/craate  the  lof-fUe.  Write  the  header  pattern. 

*1 

if  ((handle  »  open(thi8- >  log_rile_nanie,  0_RDWR|0_BINARY|0_CREAT,  0666))  <  0)  return; 
write(handle,  this->log_file_hdr,  sizeof(NpsJog_file_header)); 

/* - 

*  I  must  write  the  samples  in  time  order. 

*/ 

if  (emm_exists(&this->emm)) 

emm_map_multi(&this*>emm,  EMM_phys_page.  4,  this->emm.info->map_0123); 

if  (this-  >  ring_iull) 

{ 

size  B  (this->ring_max  -  thi8->next_8an^le)  si2eof(Diff_vector); 
if  (size)  write(handle,  this->ring_bufrer  +  this- >  next  sanq>le,  size); 

} 

size  s  this->next_sample  *  sizeof(Diff_vector); 
if  (size)  write(handle,  this- >ring_buffer,  size); 

_write(handle,  0,  0);  //  Truncate  rile  to  current  size 
close(handle); 


* - */ 

void  nps  diffplot_data  flush(Nps_dif!jplot_info  *this) 

{ 

this->ring_full  =  NO; 

this->prev_san4>Ie  ^  this->next_sample  »  0; 


• - */ 

void  nps  diffplot  data  update(Nps  difijplot  info  *this) 

{  " 

Nps_state_vector_info  "target  »  this- >  target; 

Np8_state_vector_info  "Phaser  «  this- >  chaser; 

Diff_vector  "tivec  ^  this->ring_buffBr  -I-  this->next_san9le; 

Vector  delta; 

/* - 

*/ 

if  (target- >got_one  NO  ||  chaser- >got_<»e  ==  NO)  return; 
if  (emm_exista(&this->emm)) 

emm_map_multi(&this->emm,  EMM_phys_page,  4,  thls->emm.info->map_0123); 


dlf  data.c 


dif  data.c 


vector_diffi(&cliawr->iv.pos,  &target->sv.pos,  Adeiu); 
dvec->diff[NPS_difrjpot]  «  vector_ni>giiitude(&deito); 

vector_diff(&chaser->>v.vel,  &target*>gv.vel,  duklta); 
dvec>>dify[NPS_diff_ve]]  ss  vector_inagiiitude(dulelta); 

dvec*>tiiiie  ■■  chaser- >fv.tiiDe; 

if  (this->prev_saii4>le  ss  tliis->next_taii)|)ie  &&  this->be^_tiiiie  0.0) 
this->begui_tiiiie  s  chaser- >  sv.time; 


/* - 

*/ 

lhis->prev_saiq)le  s  this*>iiext_sainple; 
this-  >  iiext_sainple'l-  -f- ; 
if  (this- >  next  sample  >s  this->ruig_inax) 
{ 

this->next_sampie  s  O; 
this->ring_fuli  *  YES; 

} 

> 


/*« 


* - */ 

void  nps  diffplot _ diq>lay  update(Nps  diffplot  info  *this,  double  t  time,  double  c  time) 

{  ■ 

Nps_state_vector_iiifo  '*1aiget  s  this- >  target; 

Nps_state_vector_info  *chaser  =  this- >  chaser; 

Vector  delta; 

/* - 

*! 

if  (target- > got  one  NO  1 1  cha8er->got  one  ss  NO) 

{ 

nps_difiplot__time(t_time,  c_time); 
return; 

} 

/♦ - 

*/ 

if  (dus->active_plot  ss  NPS_diff_pos) 

ve^or_diff(&chaser->sv.po8,  &taiget->sv.pos,  Adelta); 

else 

vector_diff(dcchaser->8v.vel,  &taiget->sv.vel,  Adelta); 

if  (this->prev_sample  ss  this->nexl_saiiqile  ii&.  this->begin_time  ss  o.O) 
this- >  begin_time  s  chaser- > sv.time; 

nps  difliplot  point(tfais->  displays  +  this->active_pIot,  vector_magnitude(&delta). 
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chaser- >sv. time  -  tlus->begiii  time,  this->active_piot,  t_time,  c  tinoe); 

) 


*  Returns: 

0  Didn’t  use  the  key 

*  1  Used  the 

2  Used  the  key.  My  sub^stem  is  done 

*  - ♦/ 

int  nps_diflpIot _ key  handler(Nps  difiplot  info  "this,  int  k^) 

{ 

int  rc  s  YES,  refresh  »  YES; 


N|>s_plot_info  *di^Uy  *  this- >  displays  +  tlus->  active j|>lot; 
Nps_plot_axis  '^axis_horz  »  dispiay->axis  +  di^lay->axis_borz; 
Npsj>lot_axis  *axis_vert  »  display- >  axis  +  display- >axis_vert; 
Nps_plot_axis  *axis; 

double  range_delta; 

/*. - 

*/ 

switch  (key) 

{ 

case  KEY_esc:  return  2; 

*! 

case  KEY_up:  axis_vert- >  range  *=  2;  break; 

case  KEY_down:  axis_vert-> range  /=  2;  break; 
case  KEYJeft:  axis_faorz->  range  /=  2;  break; 
case  KEY_right:  axis_horz->  range  2;  break; 

I* - 

♦/ 

case  KEY_cntl_up: 
case  KEY_aitl_down: 
case  KEY_cntlJeft: 
case  KEY_cntl_right: 

if  (key  »  *  KEY  cntl  up  |  ]  key  »  =  KEY  cntl_down) 

{ 

axis  «  axi8_vert; 

range  delta  b  axis->nnge/4.0; 

} 

else 

{ 

axis  B  axis_horz; 

range  delta  *  axis- >  range/6.0; 

} 


di£  data.c 


dlf  data.c 


if  (key  * «  KEY  cnti  iq>  |  {  * »  KEY  catl  right) 

{ 

if  (axis- >  origin  <  0  SiA.  -axis- >  origin  <»  range_(ielta) 
axis->origin  »  0.0; 
else  axis- >  origin  -f—  range  delta; 

} 

else 

{ 

if  (axis- > origin  >  0  &&  axis->origin  <s  range_delu) 
axis->origin  ^  0.0; 
else  axis- >  origin  --  iange_delta: 

} 

break; 

*1 

case  KEY_space: 

if  (this- >  nienu_list[this- >  menu_id]  «=  NULL)  this->menu_id  =  0; 

else  this->menu_id+-h; 

break; 

case  KEY_f9: 

this->active_plot  = 

(this->active_plot  NPS_diffjx)s  ?  NPS_diff_vel  :  NPS_diffj)Os); 
break; 

default;  rc  NO;  break; 


/* - 

*1 

if  (rc  =  =  YES  &&  refresh  =  =  YES)  ops_dif]^lot _ ^di^lay_init(this); 

return  rc; 

} 


- */ 

void  nps_diffplot _ ^display  init(Nps  difiplot_info  "this) 

{ 

Diff_vector  "'saaple; 
ushort  samples; 

int  type  s  this->active_plot; 

Npsjplot_info  *display  s  diis->diq>lays  +  this->active_piot; 
double  b^in_tiine; 


/"■- 

*/ 


dlf  data.c 


dlf  data.c 


if  (einiB_exi8ts(&thit*>eaiin)) 

eiiuii_iiiap_multi(&this->eiiini,  EMM_phys_p«ge,  4,  this->einm.iBfo->inap_0123); 
nps_difiplot_iiut(diq>l«y,  type,  this->meou_list[this->iDeDU_id]); 

/* - 

*  Figure  out  how  many  Diff  aaoqples  are  m  the  ring  buffer,  then  process 
**  all  the  valid  samples. 

*1 

if  (this- >  ring  full  *=  YES) 

{ 

samples  »  this->ring_naax; 

begin  time  «  this->begin_time  =  this- >  ring  buffer[this->next_sample].time; 

} 

else 

{ 

samples  »  this->next_sample; 

begin_time  «  this- >  begin_time  =  this- >  ring  buffer{0].time; 

} 

/* - 

*/ 

for  (sample  =  this->ring_buffer;  samples  >  0;  samples-,  sample-1- +) 

nps_diffplot _ point_fast(display,  sample- >  diff[type],  sample- >  time  -  begin_time); 


di£  data.c 


/*» 


dlfjplot.c 


jNnclude  <stdio.h> 
iNnclude  <inath.h> 

jKnclude  <tiiiies.h> 
#iiiclude  "aps-h” 


•*/ 


extern  Nps_graphics_info  nps_graphics_info; 


/*= 


I  use  these  structures  to  avoid  extra  floating-point  work  during  realtime. 


* - *! 

static  struct  //  Plot  times 

{ 


struct  viewporttype  view; 
int  linel_y,  Iine2_y; 

}  time; 

static  struct  //  Mag/Time  numbers 

{ 

struct  viewporttype  view; 
int  linel_y,  Iine2_y; 

}  mag_time; 

static  struct 

{ 

int  xl,  x2,  yl,  y2; 

}  axis; 

#deflne  STEP  PIXELS  100 

#deflne  TIME~  PIXELS  (STEP  PIXELS  *  6) 

fdcfine  MAG  PIXELS  (STEP  PIXELS  *  4) 


- */ 


/■fss  3SSS  =  3SSSSSS  =  =  S3:  =  S3SSBSS  =  =  S  = 


Static  void  points_init(void) 

{ 

int  xmax  ^  nps _g^^dlics_illfo.XlIlax; 
int  ymax  s  nps _^gnq>hics_info.ymax; 
int  c_lieight  «  nps _grq)hics_info.c_lieight; 
int  c_widtfa  =  nps _graphic8_info.c_width: 


/*- 


dlf_plot.c 
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*/ 

time.view.left  «  xmax  *  0.85;  //  Top  right  come* 

time.view.ri^t  »  time.view.left  +  c_width  •  16; 

tioie.view.top  *  ymax  *  O.OS; 

time.view.bottom  =  dme.view.top  +  c_height  *  3; 

time.view.cUp  =  YES; 

if  (tiiiie.view.right  >  xmu)  time.view.right  =  xmax  -  1; 
if  (time.view.bottom  >  ymax)  time.view.bottom  =  ymax  -  1; 

time,  line  l_y  **  c_height; 
time.lme2_y  =  (c_height  *  5)/2; 

♦/ 

mag_time. view. left  =  xmax  *  0.8S5; 
mag_time.view.right  =  mag_time. view. left  +  c_widtb  ■"  15; 
mag_time. view. top  =  ymax  0.865; 

mag_time.view.bottom  —  mag_time. view. top  +  c_hei^t  3; 
mag_time.view.clip  —  YES; 

if  (mag_time.view.right  xmax)  mag  time.view.right  =  xmax  -  1; 

mag_time.lmel_y  =  c_height; 
mag_time.line2_y  »  (c_height  *  5)/2; 

/* - 

*1 

axis.xl  s  10; 
axis.x2  =  xmax  -  1; 
axis.yl  =  0; 
axis.y2  =  ymax  *  0.834; 


/* 


void  np8_difiplot _ mit(Nps_plot_info  *info,  int  diff_type,  char  **menu) 

{ 

static  char 

mag  titleO  *  "mag(r)", 
magjabelQ  «  "Kft”, 
fmtlD  =  ■%3.ir; 

int  xmid  »  nps_jraphics_info.xmid; 
int  c_hdght  ^  nps_gnq>hics_info.c_beight; 
int  c_width  «  nps _^grq>hic8_info.c_width; 

Np8_pIot_axis  '''x_axi8  *  info- >  axis  +  NPS_axis_X; 

Nps_plot_axia  '*y_«i8  *  info- >  axis  +  NPS_axis_Y; 

int  cnt,  xl,  x2,  x3,  yl,  y2,  y3; 


dlfjplot.c 


double  step,  scale; 
char  woric[24]; 
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/* - 

*/ 

if  (time.view.bottom  »  «  0)  points_initO; 

cleardeviceO; 

setcolor(7); 

settextstyle(SMALL_FONT,  HORIZ_DIR,  nps_gniphics_info.font_size); 

/* - 

*  Draw  the  title  and  mag/time  axis. 

*1 

settextjustify(CENTER_TEXT,CENTER_TEXT); 

outtextxyfxmid,  c_heigfat,  info- >  title); 

line(axis.xl,axis.yi,  axis.xl,axis.y2); 

Iine(axis.xl,axis.y2,  axis.x2,axis.y2); 

outtextxy(xmid,  axis.y2  c_height  *  3,  "timefsec)"  ); 

/* - 

*  Draw  horizontal  ticks  (time). 

* 

*  The  range  tells  me  how  much  to  show  on  one  axis,  and  is  divided  into 
six  sections.  ”Stq>”  is  the  value  of  one  section.  Each  section  is  hard 
coded  to  be  100  pixels. 

*/ 

settextjustify(CENTER_TEXT,CENTER_TEXT); 
step  =  x_axis-  >  range  /  6.0; 

yl  =  axis.y2  -  5;  y2  -  axis.y2  +  5;  y3  =  y2  -I-  c_height/2; 

for  (cnt  =1;  cnt  <=  6;  cnt++) 

{ 

xl  =  axis.xl  +  STEP_PDCELS  cnt; 
line(xl,yl,  xl,y2); 

8printf(worit,  fintl,  step  cnt  -t-  x_axis-> origin); 
outtextxy(xl,  y3,  work); 

} 


I* - 

*  Draw  vertical  tidts  (mag). 

* 

*  The  range  tells  me  how  much  to  show  on  one  axis,  and  is  divided  into 
four  secticns,  three  of  which  are  labeled.  "Step"  is  the  value  of  one 

*  section.  Each  section  is  hard  coded  to  be  100  pixels. 


dlf  jplot.c 
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*/ 

•ettext8lyle(SMALL_FONT,  VERT_DIR,  nps_gn^»hics_info.font_*ize); 
step  B  y_axis->nuige  /  4.0; 

xl  *  axis.xl;  x2  *  axis-xl  +5;  x3  b  xl  -c_height; 

if  (step  <  1.0)  {  meg  label[0]  *  ’  etsle  b  1000.0;  } 

else  {  inag_lsbel[0r=  ’K’;  scale  »  i.O;  } 

outtextxy(x3,  axis.yT  +  c_width  *  10,  inag_lid)el); 

for  (cot  =1;  cnt  <  =s  3;  cnt++) 

{ 

yl  =  axis.y2  -  STEP_PIXELS  *  cnt; 
line(xl.yl,  x2.yl); 

sprintf(work,  fintl,  (step  *  cnt  +  y_axis->  origin)  ♦  scale); 
outtextxy(x3,  yl,  work); 

} 

scttextstylc(SMALL_FONT,  HOIUZ_DIR,  nps _gn^)hics_info.font_size); 

/* - 

*  Draw  number  box,  time  labels,  and  menu  bar. 

*/ 

settextjustify(LEFT_TEXT,CENTER_TEXT); 

xl  =  mag_time. view. left  -  c_width  *  6; 
mag_titlel4]  =  (diff_type  ==  NPS.difTpos  ?  ’r’  :  ’v’); 
outtextxy(xl,  mag_time.view.top  +  mag_time.Iinel_y,  mag_title); 
outtextxy(xl,  mag_time.view.top  +  mag_time.line2_y,  "time"); 

xl  =  time.view.left  -  c_width  *  8; 

outtextxy(xl,  time.view.top  +  time.linel _y,  info->target_title); 
outtextxy(xl,  time.view.top  +  time.line2 _y,  info->chaser_title); 

if  (menu  !«=  NULL)  nps  menuplot _ iiiit(menu); 

} 


void  nps  diflplot  time(double  tl,  double  t2) 

{ 

int  c_width  =  ops _gfiq)hics_info.c_width; 
diar  work[20]; 

/* - 

*! 

nps_plot _ ^clear_view(&tiixie.view,  NO); 

arttextju8tily(LEFT_TEXT,CENTER_TEXT); 


dlf  jplot.c 
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tl  +*  86400.0; 
tiine_dbl__to_itruig(8rtl,  work); 
outtextxy(c_width/2,  tiiiie.lbel_y,  work); 

t2  +«  86400.0; 
tiDie_dbI_to_itnng(&t2,  work); 
outtextxy(c_width/2,  tiiiie.Une2_y,  work); 

nps_plot_iiiain_viewO; 

} 


* - */ 

void  nps  diffjplot _ ^values(double  diff,  double  dtime,  int  diff_type) 

{ 

static  char  fmMimeQ  =  "%9.0f  sec*,  fnit_inagQ  =  •569.3f  Kft/s”; 
int  c_width  s  nps_graphics_info.c_width; 
char  work[32]; 

/* - 

*1 

nps_pIot _ clear_view(&niag_tinie. view,  N O); 

settextjustify(LEFr_TEXT,CENTER_TEXT); 

setcolor(7); 

if  (diff  <  1.0)  {  fnit_itiag(6]  =  ’  ’;  diff**  1000;  } 

else  {  finit_ini^6]  =  ’K’;  } 

fmt_niag[9]  =  (diff  type  =  =  NPS_diffjx)s  ?  0  :  7’); 

sprintf(work,  fmt_inag,  diff); 
outtextxy(c_width/2,  inag_tiiiie.linel_y,  work); 

qmntftwork,  fint_tinie,  dtime); 
outtextxy(c_width/2,  iiiag_time.line2_y,  work); 

nps_plot_main_view0; 

} 


void  nps_di(fplot _ poiot(Nps_p)ot_info  *info,  double  diff,  double  dtime, 

int  diff  type,  double  tl,  double  t2) 

{ 

int  xpoint,  ypoint; 

Np8_plot_axi8  ■'‘x_axis  *  info- >  axis  +  NPS_axis_X; 
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Np8_plot_txis  *y_»xis  =  info- >  axis  +  NPS_axis_Y; 

/* - - - — 

•/ 

diff  *=  iaiX)M_TO_iaLOFT; 

nps_difli)lot_tinie(tl,  t2); 
nps_diffplot_values(diff,  dtime,  diff_type); 

I* - — — — 

*/ 

xpoint  (iot)((dtitne  -  x_axis-> origin)  *  (double)TIME_PIXELS  /  x_axis->  range)  +  axis.xl; 
ypoint  =  (int)(-(diff  -  y_axis->  origin)  *  (double)MAG_PIXELS  /  y_axis- >  range)  +  axis.y2; 

if  (xpoint  >  s  0  &&  xpoint  <  nps_graphics_info.xniax 

&&.  ypoint  >  =  0  &&.  ypoint  <  nps_graphics_info.ynux)  putpixel(xpoint,  ypoint,  7); 


* - - - - */ 

void  nps  di^lot _ point  fast(Nps_plot  info  *info,  double  diff,  double  dtime) 

{  ■ 

mt  xpoint,  ypoint; 

Nps_plot_axis  '*'x_axis  =  info- >  axis  +  NPS_axis_X; 

Nps_plot_axis  *y_axis  *=  info- >  axis  +  NPS_axis_Y; 

/* - - - 

♦/ 

settextjuatily(CENTCR_TEXT,CENTER_TEXT); 

setcolor(7); 

diff  **  KILOM_TO_KILOFT; 

xpoint  =  (int)((dtinie  -  x_axis- > origin)  *  (double)TIME_PIXELS  /  x_axis-> range)  -t-  axis.xl; 
ypoint  «  (intK-(diff-y_i^s->  origin)  *  (double)MAG_PIXELS  /  y_axis- >  range)  -t-  axis.y2; 

if  (xpoint  >*  0  &&  xpoint  <  nps _graphics_info.xniax 

&&.  ypoint  >  =  0  &&  ypoint  <  nps _grBphics_info.yBiax)  putpixel(xpoint,  ypoint,  7); 
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« _ 

iKnciude  <stdlib.h> 
#inc]ude  <itdio.h> 
iKnclude  <coiiio.b> 
iKiicliide  <inath.h> 
#include  <gnphics.h> 

iKnclude  "ops-h” 


*/ 


This  function  lecieves  an  initial  position  and  velocity  vector  for  a  body 
orbiting  the  earth  and  produces  those  classical  elements  needed  by  the  f  and 

*  g  functions  for  orbit  prediction. 

*  -  -  - *  / 

void  getclas(Vector  *^>08,  Vector  *vel,  Orbmech  classicals  '^;lass.  Perturbations  *P) 

{ 

Vector  angmom,  evec,  exr,  nvec,  nxe; 

double  mu,  r,  v,  E,  Eo,  a,  h,  r_mult,  v_mult,  e,  cosnu,  sinnu,  nu; 
double  n,  sinom,  cosom; 

mu  =  P*>  Gravity. GMD.planet_mu; 

r  «  vector_nukgnitude(pos); 

V  =  vector_magnitude(vel); 

E  ss  \*\/2  •  mu/r;  //energy  not  eccentric  anomaly 

a  =  -mu/E/2; 

vector_cros8(pos,  vel,  dcangmom); 
h  =  vector_magnitude(&angmom); 

r_mult  =  v*v/mu  -  1/r; 
v_mult  =  vector_dot(pos,  vel)/mu; 

evec.x  =  r_mult'*'pos->x  -  v_mult''^el->x; 
evec.y  =  r_mult*pos->y  -  v_mult*vel->y; 
evec.z  =  r_mult*po8->z  -  v_mult*vel->z; 

e  =  vector_magnitude(&evec); 

cosnu  —  vector_dot(pos,  &evec)/r/e; 

vector_cross(&evec,  pos,  &exr): 

ritmu  »  vector_dot(&angmom,  &exr)/h/e/r; 

nu  as  atan2(siimu,cosnu); 

nvec.x  B  -angiiiom.y;  nvec.y  —  angmom.x;  nvec.z*  «  0.0; 
vector_cross(&nvec,  &evec,  &nxe); 


D  *  vfletor_aiagnitude(&avee); 

•ioom  «  vector_doC(A«iigiiKMn,Anxe)/1i/e/'n; 
coKwn  a>  vector_dot(&nvec,&evec)/e/n; 

class->a  »  a; 
class->e  *  e; 

class*>Eo  Eo  s  2*itaii(tan(nu/2)*aqit((l-e)/(l'fe))); 

class-  >  Mo  »  Eo  -  e^^inCEo); 

class- >Oo)  B  atan2(anginoin.x,-angiiioin.y); 

class- >i  s  acos(angiiK>oi.z/h); 

class- >oin  -  atan2(siDoin,cosoin): 

class- >n  »  sqrt(mii/a/a/a); 


This  functioa  uses  the  Laguere-Conway  algorithm  for  solving  Kepler's 
'*  equation  M  =  E  -  e''^in(E),  for  the  eccentric  anomaly  E,  given  the  mean 

*  anomaly  M. 

*  - */ 

void  laguere  conway(Vector  "‘MeE) 

{ 

double  M,  e,  E,  f,  fprm,  f2p,  term,  a,  b,  dE; 

M  =«  MeE->x; 
e  =  MeE->y; 

E  *  M; 
f  *  1.0; 

while  (f  >  l.Oe-lS  ) 

{ 

f  =  E  -  e*sin(E)  -  M; 
fprm  =  1  -  e*cos(E); 
f2p  =  e''^in(E); 

term  =  2'*^rt(4*(4>rm*lpiro)  -  S'f' f2p); 
a  SB  ^mn  +  term; 
b  s  fprm  -  term; 
if  (ftbs(a)  >  fri)s(b)) 
dE  =  5*f/a; 
else 

dE  -  5*f/b; 

E  =  E  -  dE; 

} 

MeE->z  s  E; 


This  function  recieves  the  a,  e,  and  Eo  elemoits  of  the  classical  element 


*'  set  for  an  accaotric  (cantral  force)  orbit,  foe  reference  position  and 

*  velocity  from  which  thty  were  developed,  and  a  time  difference  from  the  epoch 

*  of  poe,  vel,  and  produces  a  new  position  with  the  f  and  g  functions. 

*  - */ 

void  f_and _g(Vector  *poa.  Vector  *vel,  Vector  •pos_new.  Vector  •vel_new, 
Orbmech  classicals  "tlass,  double  t  diO 

double  ro,  a,  e,  Eo,  Mo,  E,  M,  n.  f.  g,  r,  fdot,  gdot; 

Vector  MeE; 

ro  «  vector_niagnitude(pos); 
a  ae  class->a; 
e  B  class->e; 

Eo  —  clam*>Eo; 

Mo  as  class- >  Mo; 
n  as  class- >n; 

M  as  Mo  +  t_dif*n; 

MeE.x  as  M;  MeE.y  =  e; 
laguere_conway(&MeE); 

E  B  MeE.z; 

r  as  a''tl-e*cos(E)); 

f  as  a*(co8(E  -  Eo)  -  l)/ro  +  1; 
g  as  (sin(E-Eo)  -  e'feinCE)  +  e*8in(Eo))/n; 
fdot  =  -sin(E-Eo)*n'fe*a/ro/r; 
gdot  =  a*(cos(E-Eo)  -  l)/r  +  1; 

pos_new->x  =  f*pos->x  +  g*vel->x; 
pos_new->y  as  fi'pos->y  +  g*vel->y; 
pos_new->z  =  f'pos->z  +  g*vel->z; 
vel_new->x  =  fdot''‘pos->x  +  gdot''^el->x; 
vel_new->y  *  fdot'''pos->y  +  gdot*vel->y; 
vel_new->z  =  fdot'''pos->z  +  gdot*vel->z; 


} 
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iKaclude  <atdlib.h> 
lindude  <stdio.h> 
jKndude  <coiiio.h> 
finclude  <inalli.h> 
fiDclude  <gnqihici.h> 


iKnclude 

MefiaeOFFO 
MefineON  1 
Mefine  TINY  l.Oe-20 
Mefioe  YES  1 
Mefine  NOO 


void  lu_bksb6(double  a(6][6],  int  n.  int  indx[6],  double  b[6]): 
void  buffer  raw  orb_sps(StiUe  vector  *nps  tans,  double  tans  buf[4][60]. 
int  tans_inat_dat[2]); 

int  lu_dcmp6(double  a[6][6],  int  n,  int  indx[6]); 


*  int  ls_fUter(State_vector  ♦tan8_in,  State_vector  *tans_out, 

*  double  tans_buf,  int  fbi,  int  potnt_nuin,  Perturbations  *P) 

*  This  filter,  created  by  Lou  Zyla  is  d^gned  to  accept  buffered  tans 

*  information  and  produce  a  smoothed  (in  a  least  squares  sense)  State_vector 

*  for  the  most  recent  point. 

*  - — •/ 

int  ls_filter(State_vector  *taiu_in,  State_vector  *tans_out, 
doiMe  tans_bof[4][60],  int  fbi, 
int  point_num,  Pnturbations  *P) 


double  xha[6],  xtrf6][7],  tran_mat[3][6],  rend_accum[6); 
double  ptpmat(6][6],  rmat[6][6],  r8d[6],  tnow,  tnext,  delta; 
double  sum,  resx,  te^,  resz,  xtrhold[6][7],  clasmat[S][7]; 
dotdrie  time,  t_fg_ref; 

Orbmech_cIaasicals  classics; 

Vector  pos_o,  veI_o,  pos_new,  vel_new; 

int  i,  j,  k,  ii,  jj,  iter,  index[6],  sing,  count,  numjwints; 

int  dfag_hoider,  xoiial_bolder,  tesseral_holdCT; 

double  time_stq>  »  10.0; 

/♦ - 

*/ 

drag_holder  *  P->Dr«g.mode; 

2oiial_bolder  *  P->Gnvity.number_zoaal; 
tessera]_bolder  «  P->Gravity.number_tesseral; 
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tiiiie_tlep  «  10.0; 

for(iter*Bl;  itw<«3;  iter++  ) 

{ 

xlui{0]  «  taiM_out->pot.x; 
xha[l]  K  taiu_out->p<M.y; 
xlui(2]  «  taiu_out->poi.z; 
xlu|3]  «  tus_out->vel.x; 
xha[4]  B  tans_out->vel.y; 
xha[5]  *  tans_out->veI.z; 

/• - 

*1 

fof(  i«0;  i<6;  i++  ) 

{ 

for(j=0;  j<7;  j++  ) 

{ 

xtifilGl  *  xtriiold[i][i]  a  xlu[i];  //xtr  is  a  6x7  matrix 

} 

} 

/* - 

*1 

fbr(  i*»0;  i<3;  i++  ) 

{ 

xtffilGl  “  xtrholdtiKi]  *  xtr[i][i]  +  5.0e-3; 

xtr(i+3](i+31  =  xtriioIdti+31ti+31  =  xtrIi+3]ti+3]  +  0.5e-3; 

} 

/* - 

*/ 

fbr(  i*0;  i<6;  i++  ) 

{ 

ftw(  j*0;  j<6;  j++  ) 

{ 

ptpmat[i]G]  »  0.0; 

> 

resid  accuiii[i]  »  0.0; 

} 

/* - 

*/ 

fbr(i»0;  i<3;  i++  ) 

{ 

ptpmBt[i][i]  «  1.0; 

fc^  acciim[i]  »  tans  buf[i][point  num]  -  xba[i]; 

}  " 

tnow  «  t  fg  ref  »  tans  out->time; 

f* - l-I - 1 - 

♦/ 

if(fbi  «»  YES) 

{ 
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BumjMniitt  »  60; 

} 

dae 

( 

niunjjxniits  *  point  num  +  1; 

) 

i  «  pcmt  mim-l; 
if(i<0)T  «  59; 

M  k*0;  k<7;  k++  ) 

{ 

pos_o.x  s  xtrliold[0][k]; 
pos_o.y  s  xtrlioId[l](kl; 
posjo.z  s  xtriiold[2](k]; 
vel_o,x  *  xtfboldI3]{k]; 
vel^o.y  s  xtrbold[4]Ik]; 
vei^o.z  s  xtfliold[S](k]; 

getcl«i(&pos_o,  &vei_o,  dcclaasics,  P); 

el«siiint(0](k]  «  clMsict.«; 
clnsntft[l][k]  «  cUasics.e: 
cUsni«t[2](kj  a  cbttsics.Eo: 
ci«aiB*t[3]Pc]  a  cUttics.Mo; 
claama^dKk]  «  claasica.n; 

} 

for(  count*  1;  count <num_point8;  count++  ) 

{ 

tnext  a  tans_buf[3Ki]; 
poa^o.x  a  x1mi[0]; 
po«_o.y  a  xha[l]; 
pos_o.z  a  xlia(2]; 
v«l_o.x  a  xiui(3]; 
vel_o.y  *  xlui[4]; 
veI_o.z  a  xba{5]; 

P->Dnit.niode  »  ON; 

P*>Gnivity.nuiBber_zonal  a  4; 
P->Gfavi^.nutid)er_teiaenI  a  4; 

ddt*  a  loext  •  tnow; 

bfprop(tnow,  &poa_o,  &vel_o,  P,  delta,  tiaie_itq>, 
&poe_o,  &vel_o); 

xha[0]  a  poa_o.x; 

xMU  “ 

x]m[2]  a  pos_o.z; 


J 
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xiM{3]  ">  vel_o.x; 
xIm[4]  ■  vel_o.y; 
xhaC5]  B  vel  o.z; 

/* - 1 - 

*/ 

tune  »  tnext  -  t_fg^_ref; 

for(k*0:  k<7;  k++  ) 

{ 

pos_o.x  s  xtriiold[0][k]; 
pos_o.y  »  xtTbold{ll[k]; 
po«_o.z  s  xtriK>ld(2][k]; 
vel_o.x  s  xtrfaold[3][k]; 
vel_o.y  «  xtrhold[4][k]; 
vei_o.z  »  x(rliold[5][k]; 

classics.*  =  clasiiiat(0](k]; 
classics.*  s  clasiiiat[l][k); 
classics.Eo  s  clasiiiat[2][k]; 
classic8.Mo  ^  clasiiiat[3][k]; 
classics.!!  —  clasinat[4][k]; 

f_aiid_g(d4>os_o,&vel_o,&pos_new,&vei_iiew,dcciassics,tiine); 

xtf(0][k]  =  pos_iiew.x; 
xtT{l][k]  *  pos_iicw.y; 
xtr(2][k]  =  pos_iiew.z; 
xtr[3][k]  *  ve!_new.x; 
xtr(4](k]  «  vel_iiew.y; 
xtr[S][k]  =5  vel  new.z; 

} 

/• - 

*/ 

tnow  s  tnext; 

for(  U»0;  u<3;  ii++  ) 

{ 

for(ij*0;  jj<3;ij++  ) 

{ 

tian  iiiat[ii]Qj]  *  (xtr(ii][ij]-xtr[u][6])/5.0e-3; 
tnn~iiiat[U]Qj+3]  »  (xtr(U][ij+3]-xtr[iiK6])/O.Se-3; 

} 

} 

/* - 

*/ 

for(  ii*0;  ii<6;  ii++  ) 

{ 

for(j»0;  j<6;  j++  ) 

{ 

sum  *  0.0; 
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for(k>0;  k<3;  k++  ) 

{ 

sum  B  sum  +  tnn  m«tPcHu]‘*tnm  mat[k][j]; 

} 

ptpiuU[u]|j]  s  ptpmat[ii](}]  +  sum; 

} 

} 

/♦ - 

*1 

lesx  St  taDs_buf[01[i]  •  xha[0]: 
fesy  «  tans_buf[l][i]  •  xhs[l]; 
resz  »  tans  buf[2][i]  •  xha{2]; 

/• - 1 - 

*/ 

for(k«0;  k<6;  k++  ) 

{ 

fesid_accum[k]  ^  reaid_accum[k]  -f  resx*tnn_mat[0][k]  -f 
resy'^nui_mat[l][k]  +  resz'Hran_mat[2][k]; 

} 

i--; 

if(  i<0  )  i  =  59; 

}  //for(  countsO;  count  <  num_points;  count++  ) 

/♦ - 

*/ 

for(  i=0;  i<6;  i++  ) 

{ 

rsd[i]  as  resid_accumti]; 
for(j=0;  j<^;  j++  ) 

{ 

nnat[i][j]  =  ptpmatpJQ]; 

} 

} 

/* - 

♦/ 


sing  lu_dcnq>6(rmat,  6,  index); 
lu  Ucsb6(nnat,  6,  index,  rsd); 

/*! - 

*/ 

tans_out->pos.x  «  tans_out->pos.x  +  rsd[0]; 
tans_out->pos.y  =  tans_oul*>pos.y  +  nd[]]; 
tans_out->pos.z  tans_out- >  pos.z  +  nd[2]: 
tans_out->vei.x  «  tans_out->vel.x  +  rsd[3]; 
tans_out*>vel.y  *  tans_out->vel.y  +  rsd[4]; 
tans_out->vel.z  »  tans_out->vel.z  +  rsd[S]; 

}  //  for(  iterasi;  iter<s3;  iter++  ) 
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P->Dng.mode  »  drig^holder; 

P->  Gravity  .nuiiiber_zoiiaJ  »  BHial_holder; 

P->  Gravity  .auniber_tesaeral  »  tesaeral_bol(ler; 

retum(sing); 

} 

*  int  Iu_dctiip6(a,  n,  indx,  sing)... This  function  is  the  L-U  decomposition 

*  from  Numerical  Recipies. 

*- - *! 

int  iu_dcmp6(double  a[6][6].  int  n,  int  indx[6]) 

{ 

double  big,  dum,  sum,  temp,  vv[6]; 

int  i,  imax,  j,  k,  sing; 

sing  »  NO; 

for(  i«0;  i<n;  i++  ) 

{ 

big  =  0.0; 

for(j=0;  j<n;  j++  ) 

{ 

if((temp  «  fabs(a[i][j]))  >  big )  big  =  temp; 

} 

if(big==0.0)  sing  =  YES; 
vv[i]  s»  1.0/big; 

} 

for(j=0;  j<n;  j++  ) 

{ 

foK  i=0;  i<j;  i++  ) 

{ 

sum  =  a[i]D]; 

for(  k=0;  k<i;  k++  ) 

{ 

sum  -*  a[i][k]*atklCjl; 

} 

a[i][j]  =  sum; 

} 

big  =  0.0; 

for(  i=j;  i<n;  i++  ) 

{ 

sum  »  a[i]D]; 
for(k=0;  k<j;  k++  ) 

{ 

sum  -*  a[ilM*atk]tjl; 

} 

ali][j]  »  sum; 

i^  (dum  »  vv[i]*fabs(8um))  >  =  big) 
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{ 

big  s  dum;  imu  »  i; 

) 
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} 

if(  j  ! »  imax  ) 

{ 

f(wr(  k«0;  k<n;  k++  ) 

{ 

dum  «  a[imax][k]; 
a[imax][k]  =  t[j][k]; 

•OIM  =  dum; 

} 

w[iinax]  »  vv[j]; 

) 

indxlj]  =  imax; 

if(  *aiW  *=  0.0  )  aC][j]  =  TINY; 
if(  j  !=  n-1  ) 

{ 

dum  =s  1.0/a[j][)]; 

for(  i*j+l;  i<ii;  i++  )  a(i][j]  dum; 

} 

} 

retuni(sing); 

} 


*  lu_bksb6(double  a[6][6],  int  n,  int  indx[6],  double  b[6)) 

this  function  performs  the  back  substitution  after  a  decomposition. 
It  Hr  from  Numerical  Recipies. 

*  - */ 

void  lu_bksb6(double  a[6][6],  int  n,  int  indx[6],  double  b[6]) 

{ 


float  sum; 
int  i,  ip,  j,  ii=0; 


for(  i=0;  i<n;  i++  ) 

{ 

ip  =  indx[i]; 
sum  =  b[ip]; 
b[ip]  «  b[i]; 

if(ii) 

{ 

for(j=ii;  j<=i-l;  j++  ) 

{ 

sum  -*s  a[i](i]*b(j]; 

} 

} 
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else 

( 

if  (sum)  ii  *  i; 

} 

b[i]  »  sum; 

} 

fbr(  i>“0;  i-- ) 

{ 

sum  B  b[i]; 

for(j»i+l;  j<n;  j++  ) 

{ 

sum  -»  st«101*Hjl; 

} 

b[i]  s  sum/s[i][i]; 

} 

} 

#ifdef  OLD_nLTER 


bufrer_raw_tans(Sute_vector  *nps_tjuis,  double  tans_buf[4][60], 
int  tsns_mat_dat[2]) 

*  This  function  cieates  a  ring  buffer  for  unmodified  tans  information  as  it 

*  arrives  in  the  NPS  subroutines.  The  buffer  is  used  by  LSFILTER.C  to  smooth 

*  some  of  the  error  due  to  the  SA  code  out  of  the  tans  state  vector 

*  information. 

*  _ */ 

void  buffer_raw_orb_gps(State_vecior  '*nps_tans,  double  tans_bufI4][60], 
int  tans_mat_dat[2]) 


{ 

int  tan8_wrt; 

tans_wrt  3:  tans_mat_dat[l]; 

tans_buf[0][tans_wit]  =  nps_tans->pos.x; 
tans_buf[ll[tans_wrt]  *  nps_tans->pos.y; 
tans_buf[2][tans_wrt]  =  nps_tans->pos.z; 
tms_buf[3][tans_wrt]  =  nps_tans- >  time; 
tans_mat_dat[l]  »  tans_wrt  4-  1; 
iff  tans  mat  dat[l]  60 ) 

{ 

tans_mat_dat[l]  »  0; 
tans  mat_dat[0]  «=  YES; 

} 

} 

#endlf  OLD_FILTER 
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* - */ 

#include  <string.h> 

finclude  "nps.b” 


♦ - */ 

extern  Nps_gt«phics_info  nps_gnphics_iflfo; 

I  use  these  structures  to  avoid  extra  floating-point  work  during  realtime, 
f - */ 

static  struct  //  Plot  menus 

{ 

struct  viewporttype  view; 
int  height,  linel_y,  Iine2_y; 

}  menu; 


♦ - 0/ 

static  void  points  init(void) 

{ 

int  xmax  »  nps_gn^)hics_info.xmax; 
int  ymax  s  nps_gr8phics_info.ymax; 
int  c_height  =  nps_graphics_info.c_height; 

/* - 

*/ 

menu.view.Ieft  =  0; 
menu.view.right  =  xmax  -  1; 

menu.view.top  =  ymax  -  1  -  (menu.height  =  c^height  *  3  -  c_height/4); 
menu.view.bottom  =  ymax  -  1; 
menu.view.clip  =  YES; 

menu.linel_y  ^  c_height  -  c_height/4; 
menu.line2_y  =  menu.linel_y  +  c_height; 


void  nps  menuplot _ init(char  ^’''labels) 

{ 

int  box,  X,  x_delta; 
char  '*text; 
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/* - - - 

*/ 

if  (menu.height  «  =  0)  points_initO; 

npsj>lot _ ^clear  viewf&monu.view,  YES); 

settextjustify(Cii'rrER_TEXT,CENTER_TEXT); 

x_delta  =  (menu.view.right  +  1)  /  10; 

for  (box  =  0,  X  =  menu.view.left; 
box  <  10; 

box+  +  ,  l*bels+  +  ,  X  +  =  x_delta) 

if  (box  >  0)  line(x,  0,  x,  menu.height); 

if  ((text  =  ^labels)  »  =  NULL)  continue; 

outtextxy(x  +  x_delta/2,  nienu.linel_y,  text); 

text  +=  8trieo(text)  +  1; 

outtextxy(x  +  x  delta/2,  menu.Iine2_y,  text); 

} 

nps_plot _ main  viewQ; 

} 
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» _ _ *1 

#include  <stdio.h> 

#iiiclude  <coiuo.b> 
ifiaclude  <8tring.h> 

(include  <dir.h> 
iKnclude  <signal.h> 

#iiiclude  <edit_rt.h> 

#uicliide  <times.h> 

#ifdef  DEBUG 
#include  <edit.h> 

#endif  DEBUG 

ji^Iude  "ops.h* 

#mclude  "nps^mSO.h* 


**  Only  one  each  of  these  structures  exists. 


Nps  graphics  info  nps  graphics  info  « 
{  ■ 


{0},  /*  struct  viewporttype  nMin_view  */ 

0,0,0, 

/*  int  xmax,  xmid,  c_width 

*1 

0,0,0, 

/*  int  ymax,  ymid,  c_height 

*! 

4, 

/*  int  font_size  32x32  pixels 

*! 

NO,  0 

/♦  int  in_grq>iiics_niode,  page 

*! 

}; 


Enun_info  nps_enun_info; 


This  enumeratirai  defines  the  various  sub-plots  of  this  qrstem.  The  static 

*  variable  holds  the  current  sub-plot,  and  starts  as  zero  (_main  menu). 

♦  _ _ _ _ — — - */ 

enum  npsjrlots 

{ 

NPS_main_menu, 

NPS  spas  gps  orb  gps,  NPS_spa8  £ps  orb  ins, 

NPS_<rt  gps  orb  ins,  NPS_orb_sawiu)odi, 

NPS~qjas_gps_orb_tgt,  NPS_tgt_sawtooth, 

NPS  orb  tgt  orb  gps,  NPS  orb  tgt  orb  ins, 

NPS_orb _gps_pitch_yaw,  NPS_orb_iiis_pitch _>aw, 

NPS_orb_ins_spas  gps  pitch _yaw, 
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NPS_edit_iiwau, 
NPS  mu 

>; 


itatic  eoum  npsjilots  nps_rab_plot  ^  NPS_mu; 


*  The  SPAS  vector  has  two  possible  sources,  as  does  the  Orbiter-GPS.  Some 
of  the  sources  are  WGS84  and  need  conversion  to  MSO,  there  are  currently  two 

*  routines  for  conversion. 

*  - *! 

iWfdef  NPS_GPS 

enum  spas_sources  {  SPAS_8pas_^ps,  SPAS_8pas_8v,  SPAS_src_mu  }; 
enum  gps_8ources  {  ORB_GW_m^,  ORB_GPS_ecef,  ORB_GPS_8rc_mu  }; 

static  Nps_8tate_vector_info  spas  gps  =  {  YES,  NO,  SPAS_q>as  gps.  NPS_MSO_from_iIoad  }; 
static  Nps  state_vector_info  orb _gps  =  {  YES,  NO,  ORB_GPS  mSO,  NK  MSO  fromjload  }; 
#bndif  Nre_GPS 

static  Nps_state_vector_info  orb_ins  =  {  YES,  NO  }; 
static  Nps_quatemion_info  orb_quat  =  {  YES,  NO  }; 
static  Nps_state_vector_info  orb_tgt  «  {  YES,  NO  }; 


*  The  perturbations  structure  is  declared  fsr  because  it’s  rather  large.  It 

is  used  for  both  vdiicles:  orbiter  and  spas.  Only  the  ballistic  number  needs 
changing  from  vehicle  to  vdiicle. 

*  - ♦/ 

static  Perturbations  for  nps_P; 

static  double  orb_ballistic_number  =  64.0; 
static  double  spas_ballistic_number  =  64.0; 


double  nps_newest_time; 


Npsjrredictor  npsjpredictor  « 

{ 

NPS_predict_off,  40,  60.0,  8.0,  0.0,  &ops  P,  &orb_quat, 
{  NO,  NO,  NO  } 

}; 


mt  nps_dap_on; 

Nps_rvplot_info  •nps_dap_plot; 
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*  These  memis  ere  used  by  tbe  plots. 

•  - - - •/ 

static  char 


ineou_str_spD 

=  •SPACEVO' 

"Alt  Menus*, 

iiienu_8tr_escQ 

■  ’ESCNO’ 

■prev  scm*. 

ifdcf  NPS_GPS 
inenu_8tr_flD 

*  "FIVO" 

*Spas/0-GPS*. 

iiieou_str_f2Q 

=  "F2\0’ 

■Spas/OINS*. 

iiiMiu_8tr_f3(] 

*  'FSNO' 

'O-GPS/INS*. 

inenu_8tr_sfJ[] 

«  'Shft-FaNO* 

*Saw  -  ORB*, 

inenu_str_f4D 

=  ••F4\0' 

*SpasnXiT*, 

menu_8tr_sf4[] 

*  ■'Shft-F4\0" 

•Saw  .  TGT*, 

menu  str  fSQ 

=  "F5\0* 

•TGT/O-GPS*, 

# 

endif" Nre_GI»S 
iiienu_str_f6n 

=  ’F6\0" 

•TGT/O-INS", 

meou_str_f7n 

"Singl  Pred*, 

nienu_str_f8Q 

=  •F8\0* 

*Auto  Pred*, 

ineou_8tr_sf6[] 

=  ’Shft-FdNO' 

•Rbar-Vbar*, 

iiieou_str_sf7[] 

«  •Shft-F7\0" 

•Vbar-Hhar*, 

inenu_str_sf8Q 

=  "Shft-FSNO" 

•Rbar-Hbar*, 

menu  str  si9[] 

=  "Shft*F9\0' 

•Hbar  on/ofT, 

# 

ifdef  NPS.GPS 
menu  str  ii^ 

=  •F9\0'' 

•Toggle*. 

0 

endif Ntre_GPS 
menu_8tr_flOQ 

=  "F10\0" 

•Settings*, 

menu_str_afl[] 

=  "Alt-FlVO" 

"Freeze  Scm" 

menu_str_af5Q 

=  "Alt-F5\0" 

"Pitch/Yaw", 

m«iu_str_af6D 

=  ’Alt-F6\0" 

"Fast  p/y". 

menu_str_af7n 

=  "Alt-FTyO" 

"Wipe  one". 

menu_str_af8D 

=  -Alt-FSNO" 

"Wipe  Plots", 

menu_str_aflOD 

=  "AIt-FI0\0" 

"Save  plots". 

0 

ifdef  NPS_GPS 
menu_8tr_cflD 

*  "Cntl-FIVO" 

•Flit  O-GPS", 

menu  str  cfSQ 

=  *Cntl-F2\0'' 

•->  off". 

0 

ifdef  NEW  FILTER  SPAS 

menu_8tr_cf3[] 

=  "Cntl-FSVO" 

•Filt  Spas", 

moiu  str  cf4Q 

*  ’Cntl-F4\0' 

•->  off". 

0 

endif  NEW  FILTER  SPAS 

0 

oidif  NPS_GPS 
menu_str_cf6[] 

*  'Cntl-FdNO* 

•RNDV  Pred 

m«iu_str_cf7Q 

=  "Cntl-FTNO" 

•DAP  mode", 

menu_8tr_cf8D 

»  "CnU-F8\0" 

•Clr  thrust". 

menu_str_cl9D 

=  •Cnti-F9\0' 

"Prop  all". 
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nieou_8tr_zooinzQ  »  'Up-DownVO"  'Ijoom  Z*, 
iiienu_ftr_zooiiixQ  »  *Left*Right\0*  'Zoom  X", 
meau  strjMozO  ■  *CNTL  i^>-doV0*  "Pui  Z", 
iiieou~ilr_|»«iixD  -  ’CNTL  lf-rt\0'  "Pto  X*. 
iiieou_str_hoioeQ  «  *HOME  findVO*  *  Taiset”, 
iiieau_str_endQ  “  *END  findVO*  *  Orbiter*; 

static  char  *rv  saw  menulQ  s 

{ 

menu_str_q), 

#  ifdefNPS_GPS 

menu_str_fl,  menu_str_G,  ineau_8tir_fl, 
naenu_str_f4,  nieou_str_C,  iDenu_str_f6, 

#  else 

NULL.  NUU..  NULL, 

NULL,  NULL,  inenu_str  f6, 

#  endif  NPS_GPS 

menu_str_f7,  nienu_str_f8, 
mmu  str  flO 

}; 


static  char  *n  saw  iDeau2aQ  » 

{ 

menu  str  sp, 

NULL,  NULL, 

NULL,  NULL, 
menu_str_sf6,  menu_str_sf7, 
nienu_8tr_sf8,  menu_str_s<9, 
menu  str  flO 

}; 


#ifdef  NPS_GPS 

static  char  *rv_saw_menu2b0  = 

{ 

menu_8tr_sp,  NULL,  NULL, 
menu  str  si3,  menu_str_sf4, 

NULL,  NULL, 

menu_str  f9,  NULL,  mrau  str_flO 

#aidif  NPS_GPS 

static  char  *n  saw_menu3Q  s 

{ 

menu_str_sp,  NULL,  menu_str_af5,  meau_str_af6,  NULL,  NULL, 
menu  str  ai7,  menu_str  afS,  NULL,  menu  str_aflO 
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•talk  char  *rv  aaw  nMati4Q  ■ 

{ 

BMiiu_str_ap, 

#  ifdefNPS.GPS 

neau  atr  efl,  meau  atr  cC, 

#  iftlef N^_nLTEirsS\S 
aieau_atr_cf3,  Bieau_atr_cf4. 

#  elae 

NULL,  NULL, 

#  eedif  NEW  HLTER.SPAS 

#  dae 

NULL,  NULL, 

NULL,  NULL, 

#  endifNPS.GPS 

#  ifdefNPS_RNDV 
nMau_atr_cf6, 

#  elae 
NULL, 

#  eodif  NPS_RNDV 

aieau_atr_cf7,  Bienu_atr_cfB,  Bieou_atr_cf9, 
aienu  atr  flO 

}; 


atatic  char  *rv  aaw  aieeuSQ  « 

{ 

aMau_atr_ap,  a)enu_atr_eac,  NULL, 

aieau_atr_aooBiz,  Bienu_atr_xooaH,  n)enu_atrj)aiiz,  B)eau_atr_panx, 
aieeu_atr_boaie,  Bienu_atr_end, 
aieau_atr  flO 

}; 

•talk  char  **rf  aaw  menu  liatQ  » 

{ 

rv  aaw  aienul,  fv_aaw_Bienu2a, 

#  tf&ffn>S_GPS 
rv  aaw  aieau2b, 

#  ei^fI^_GPS 

rv_aaw  aieau3,  rv_aaw  aienu4,  rv  aaw  meauS,  NULL 
>;  ■ 


atatic  diar  *py  aieatiO  * 

{ 

aieau  atr  eac. 


#  ifdef  NPS.GPS 

menu_atr_fl,  nienu_atr_f2,  iiienu_atr_C, 
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iiieou_ilr_f4,  nienu_str_f5,  iiieou_ftr_f6, 
NULL,  iiMOu_str_f9, 

0  dae 

NULL,  NULL,  NULL, 

NULL.  NULL,  menu  ttr  f6, 

NULL,  NULL, 

0  eadifNPS_GPS 

menu  str  flO 

}; 


static  char 
0  ifiiefNPS_GPS 

titlc_str_oib_gpsQ  *  "Orb^PS", 
title  str  spas(10]  'Spas-CPS*, 

*title_ste  spaa  sfcO  =  {  “Spas-GPS*.  'Spas-SV  }, 

0  endifNK.GK 

title_str_oih_ia8Q  =  "Orb*INS*, 
titlc_str_orb_tgtO  =  "Targ-INS"; 

static  Nps_Iog_fiIe_iieader  iog_file_header  ^  {  ‘NPS  Temporify  Plot  Oiata\xla''  }; 


'*  1  have  one  of  these  structures  per  RVbar  plot,  the  names  are  composed  of 

*  target  first,  chaser  second. 

*  -■  -  --  */ 

(Tifdef  NPS_GPS 

static  Nps_rvplot  info  spas _gps_oih_gp8  = 

{ 

{ 

NULL,  title_str  spas,  title  str_ofb_gps, 

{  {  0.0,  25.6  },"{  0.0,  25.6/32  },  {  0.0,  25.6  }  }. 

NPS  axis  Z.  NPS  axis  X 

}. 

NULL,  0,  0,0,NO. 

rv_saw_meiiu_list,  0,  YES,  NPS_rvplot_rv, 

”sgpsogps.i4>s”,  &iog_file_header,  {0}, 

jp»,  Siotb jtpa,  &opa_predictor,  0.0,  0.0 


static  Nps  rvpiot  info  qaas_^_orb  ins  « 

{ 

NULL,  title  str  spas,  title  str_orb  ins, 

{  {  0.0,  25.6  },“{  0.0,  25.6/32  },  {  0.0,  25.6  }  }, 
NPS_axis  Z,  NPS  axis_X 

}. 
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NULL,  0.  0,0.NO. 

rv_Mw_iiMmi_Uit,  0,  YES,  NPS_fvpk>t_fv, 

*«gpK>iiit.i4W*.  &log;_fU«_hMd«',  {0}. 

Aapu  fp».  Aofb  ins,  ikiips_pradictor,  0.0,  0.0 

}; 

•tirtk  Npt_rvplot  info  orb  m  orb  ini  * 

{ 

{ 

NULL,  tide  itr  orb j/pt,  dtle  itr  orb  ini, 

{  {  0.0,  25.6/32  },  {  0.0,  25.6/32"},  {" 0.0,  25.6/32  }  }, 
NPS_axii  Z,  NFS  axil  X 

}. 

NULL,  800,  0,0,NO, 

rv_iiw_inenu_lirt,  0,  YES,  NPS_ivplot_fv, 

*ogpioina.iipi*,  &log_file_lieider,  {0}, 

Aorb j(pa,  Aoib_ina,  Anpa_predictor,  0.0,  0.0 


aUdc  Npa  rvpiot  info  ipai  fpi  oib  tgt  « 

( 

NULL,  dde  atr  apai,  dde  atr  orb  tgt, 

{  (  0.0,  25.6/32  ),  {  0.0,  75.6/32'},  {  0.0,  25.6/32  }  }, 
NFS  ixii  Z,  NFS  axia  X 

}. 

NULL,  800,  0,0,NO, 

rv_aaw_menu_Iiat,  0,  YES,  NFS_ivplot_rv, 

*agpao(gt.npa*,  &log_file_header,  {0}, 

A^ea _gpa,  Aorb  tgt,  Anpa_predictor,  0.0,  0.0 

}; 


static  Npa  rvpiot  info  orb  tgt  orb _jps  = 

( 

{ 

NULL,  title  atr  orb  tgt,  dde  atr  orb_gps, 

{  {  0.0,  25.6  },"{  0.0,  25.6/32  },"{  0.0,  25.6  >  }, 
NFS  axia  Z,  NFS  axia  X 

}. 

NULL,  800,  0,0,NO, 

rv_axw_nienu_liit,  0,  YES,  NFS_rvplot_rv, 
*otgtogpa.npa”,  Al(^_file_beader,  {0}, 

Aorb  tgt,  Aorb_gpa,  Anpa_pfedictor,  0.0,  0.0 

>; 

jfondifNFS_GFS 

atatic  Npa  rv|riot_info  ofb_tgt_orb  ina  « 

{ 
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{ 

NULL,  tide  Mr  orb  tgt,  dtle  Mr  orb  ins, 

{  {  0.0,  25.6  }.”(  0.0,  25.6/32  },~{  o7o,  25.6  }  }, 

NPS  axis  Z,  NPS  axis  X 

}. 

NULL,  800.  O.O.NO. 

rv_aaw_iiienu_UM,  0,  YES,  NPS_rvplot_rv, 
*otgtoins.nps*,  &Iog_{ile_beader,  {0}, 

&orb_tgt,  &oib_ins,  Aopajpiedictor,  0.0,  0.0 


1  have  one  of  these  structures  per  difference  (sawtooth)  plot. 

• - *! 

fifdef  NPS_GPS 

static  Nps_diffplot  info  orb  sawtooth  ^ 

{ 

{  /*  Nps_plot_info  diaplays[2]  *! 

{  "GPS/INS  Position  Difference  vs.  Hme*, 
dde  str  orb_^gps,  dde  Mr  orb  ins, 

{  {  0.0,’60000.0  }.  {  0.0."4.0'},  {  0.0,  0.0  }  }. 
NPS  axis  Y,  NPS  axis  X  }, 

{  -GPi/INS  Velocity  Difference  vs.  Time*, 
dtle  str  orb_fps,  dde  Mr  orb  ins, 

{  {  0.0,“60000.0  },  {  0.0."0.004  },  {  0.0,  0.0  }  }. 
NPS  axis  Y,  NPS  axis  X  } 

} 

NULL,  0,  0,0, NO, 

0.0,  rv_saw_nieau_liM,  0,  NPS_diff_pos, 

*orb_saw.nps*,  &iog_file_beadw,  {0}, 

&orb _gps,  &orb  ins 

}; 


static  Nps  difiplot  info  tgt_sawtooth  = 

{ 

{  /*  Nps_plot_info  diaplays(2]  */ 

{  "SPAS/TGT  Position  Difference  vs.  Time”, 
dde  str  spas,  dtle  str  orb  tgt, 

{  {  0.0.’60000.0  >7  {  0.0,  4.0  },  {  0.0,  0.0  }  }. 
NPS_axis_Y,  NPS_axis_X  }. 

{  *SPAS/TGT  Velocity  IXffneace  vs.  lune”, 
dde  str_spas,  dtle  str  orb_(gt, 

{  {  0.0,  60000.0  }T  {  0.0,  0.004  },  {  0.0,  0.0  }  }, 
NPS  axis  Y.  NPS  axis  X  } 

}. 

NULL,  0.  O.O.NO. 

0.0,  rv_saw_menu_liM,  0,  NPS_diff_pos, 
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''tst_nw.npe''.  &Iog_itle_header,  {0}, 
itapaijff*,  &orb  tgt 

}; 

#nidif  NPS_GPS 


'*  1  have  one  of  these  structures  per  pitch-yaw  plot. 

* _ 

#ifdcf  NPS_GPS 

static  Nps_pypiot  info  orb _gps_py  - 

{ 

NULL,  title  str_spas,  title  str  ofb_^gps,  py_iiieou 

}: 

iltendifNPS_GPS 

static  Nps_pyplot  info  ofb_ins_py  — 

{ 

NULL,  title  str  orb  tgt,  title_8tr  orb_in8,  py  menu 

h 


■*! 


)Kfdef  NPS_GPS 

static  Nps_pyplot  info  orb  ins  spas_gps_py  — 

( 

NULL,  title  str  spas,  title  str  orb  ins,  py  menu 

}; 

#en<lif  NPS_GPS 

static  int  nps_py_plot  =  NPS_orb_ins_pitch_yaw; 
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static  double  prev_show_tinie,  prev_save_time; 

static  double  sample_rBte_show  «  0.0,  san9le_rate_save 

static  double  prq>_8tep  =  10.0;  //  10  secs 

static  double  prq)_niax_time  s  1800.0;  //  30  minutes 

static  int  prop_cU_input_tiiDe  =  NO; 

static  int  nps_nieou_frozen  =  NO; 

static  int  gdriver  »  DETECT,  gmode; 
static  int  np8_save_floppy  »  NO; 


-*/ 
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Hfidef  NPS_GPS 

•Utic  Nps  filter  info  orb  jgpt  filter  « 

(  ■  ~ 

NO,  NO,  NO,  I*  on,  auto_ferun,  input_aaved 

9,0,  300.0,  0.0,  /*  nve_itep,  renin_step,  Dext_renin  */ 

(0},  /*  input_vector  •/ 

0,  0,  NO,  /*  piev_iatq>le,  next^iample,  full  *! 

{0}  /♦  ring_bufrer  *! 

}; 

#ifdef  NEW_HLTER_SPAS 

static  Nps_filter  info  spas^gps  filter  » 

{ 

NO,  NO,  NO,  /*  on,  auto_rerun,  input_saved 

9.0,  300.0,  0.0,  I*  aave_stq),  rerun_step,  next_renin  *! 

{0},  I*  input_vector  *! 

0,  0,  NO,  /*  pfev_sampie,  next_sanq>le,  full 

{0}  /*  ring  buffer  */ 

}; 

#endif  NEW  HLTER  SPAS 
fendif  NPS_GPS 


*/ 


*/ 


/♦sss 


* - */ 

(IWcfine  RING_MAX_DEFAULT  0x8000 

int  nps_systeni  initO 

{ 

static  char 

ring_env  nameO  *  "NPS  RING_MAX*, 

#  ifdef  Nre_GPS 
iload_env_nanieG  **  *NPS_ILOAD", 
iload  fileO  ^  "tans.ild", 

#  endif" NPS_GPS 

config  fileQ  »  "nps.cfg", 
fintlD"=  *%i*TVnH6*lc"; 

FILE  "'config; 

char  '^lename,  "'ring_niax: 

ushort  ring_niax_niem; 

ushort  cfg_menil,  cfg_niem2,  cfg_niem3,  cfg_nieni3a,  cfg_mem4,  cfg_mem4a; 
ushort  cfg_meni5,  cfg_nieni6,  cfg_enun,  cfg_flp,  cfg_year; 

/* - 

*  Blatant  kludge  until  we  can  find  the  source  of  overflow  errors. 

*/ 
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sigDaKSlGFPE,  SIGJGN); 

- 

*! 

if  (bgprop_iiiitO  *  *  NO)  letum  NO; 

#  ifdefNPS_GPS 

if  ((filename  at  getenv(iload_eav_name))  « «  NULL)  filename  as  iload_file; 

if  (nps  wgs84_read  iload(filename)  »  *  NO) 

{ 

printfCCan’t  <q)en  iload  file  <%s>\n*,  filename); 
retun  NO; 

) 

#  eodif  NPS_GPS 

/* - - 

*! 

nps_P.Dng.mode  «  ON; 
npa_P.Dng.solar_flux  »  185.9593403793603; 
nps_P.Dng.nieao_aolar_fliix  —  178.6447698684861; 
np8_P.Dng.geomagnetic_index_ap  =  19.87811961456716; 
nps_P.Dng.ballistic_number  »=  64.0; 

nps_P.Gnvity.number_zonal  =  4; 
np8_P.Gnvi<y.number_tcssenl  =  4; 
instantiate _goq>ot(l,  &nps_P); 

/* - 

*/ 

if  ((ring  max  «  geteov(ring  env_name))  !-  NULL) 

{ 

sscanf(ring_n]ax,  &ring_max_mem); 

if  (ring_n)ax  mem  <  1024)  ring_max_a]em  —  1024; 

} 

else  ring_max_mem  *  RING_MAX_DEFAULT; 

cfg_meml  =  cfg_meoi2  *=  cfg_mem3  =  cfg_mein3a  = 
cfg_mem4  =  cfg_mem4a  =  cfg_mem5  =  cfg_meni6  =  0; 
cfg_flp  =  NO; 
cfg  year  ®  NO; 
cfg_emm  =  YES; 

if  ((config  =  fopen(c(mfig  file,  *rt*))  NULL) 

{ 

iwanficonfig,  fintl,  &cfg_meml);  /♦  Spas-gps  vs  Orb-gps  RV  ■*/ 

fscanficonfig,  fintl,  &cfg_mem2);  /*  Spas*gps  vs  Orb-ins  RV  */ 

fscanficonfig,  fintl,  &cfg_mem3);  /*  Orb-gps  vs  Orb-ins  RV  */ 
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ltscanf(config,  fmtl,  &cfg_niein3a);  /*  Orb-gps  vs  Orb-ios  SAW '*'/ 

ftcaafCconfig.  fintl,  &cfg_m6ni4);  /*  S^~gps  vs  Twg-ins  RV  *1 

fiKinf(coniig,  fmtl,  &cfg_iiieiD4a);  /*  Spas-gpa  vs  Targ-ins  SAW  */ 

fac»af(coaIig,  fintl,  StcfgjaaemS);  /*  Targ-ins  vs  Orb-gps  RV  */ 

fkanf(coofig.  fintl,  &cfg_ineiD6);  /*  Targ-ins  vs  Orb-ins  RV  */ 

ftcanfCconfig,  fintl,  d(cfg_enun):  I*  Expanded  memoiy  yessl/nosO  *! 

fscanf(config,  fintl,  &cfg_flp):  Save  to  floppy  yes=l/nosO  */ 

fiKanf(config,  fintl,  &cfg  year):  I*  Year  for  propagation  math  *! 
fclose(config); 

> 

if  (cfg_enun)  emm_info_construct(&ops_einni_info); 
nps_save_floppy  »=  cfg_flp; 
if(cfg_year)  bgpiop_year(cfg_year); 

/* - 

*1 

0  ifdefNPS  GPS 

if  (nps_rvplot_data_init(&spas_^gp8_orb_gps,  riog_max_niem,  cfg_nieml,  &nps_enun_info)  ==  NO 

I  j  nps_rvplot_daia_init(&8pas_gps_OTb_ins,  ring_max_mem,  cfg_mem2,  &nps_emm_info)  =  =  NO 

j  j  nps_rvplot data_init(&orb_gps_orb__ins,  ring_max_mein,  cfg_nieni3,  &nps_enun_info)  =  =  NO 

j  I  nps_diffplot__data_init(&orb_sawtooth,  nng_inax_inem,  cfg_inem3a,  &nps_emm_info)  =  =  NO 

I I  nps_rvplot _ ^data_init(&spas_gps_orb_tgt,  rmg_niax_ineni,  cfg_nicm4,  &nps_enun_info)  =  =  NO 

1 1  nps_dififplot_data_init(&tgt_sawtooth,  ring_inax_mem,  cfg_mem4a,  &nps_enun_^info)  = «  NO 

1 1  nps_rvplot__data_init(&orb_tgt orb_gps,  ring_max_meni,  cfg_niem5,  &nps_enu»_info)  =  =  NO 

1 1  nps_rvplot_data_init(&ofb_tgt_orb_ins,  ring_inxx_n)ein,  cfg_ineni6,  &nps_emn]_info)  *=  =  NO) 
0  else 

if  (nps  rvplot  data  init(&orb  tgt  orb  ins,  ring_niax_mem,  cfg_niem6,  &nps_emm_info)  =  =  NO) 
0  endif  NPS  GPS 
{ 

printfCOut  of  memory,  set  %s  env-variabie  to  <  %04X\nOr  ctiange  file  %s\n”, 
ring_env_name,  ring_max_mem,  config_file); 
return  NO; 

} 

#ifdef  DEBUG 

gdriver  =  edit_integer("Cbange  gdriver  ?  ",  gdrivcr); 
gmode  —  edit_integer(*Quuige  gmode  ?  ",  gmode); 

#endif  DEBUG 

return  YES; 

) 

static  void  nps_i^stem  save(void) 

{ 

if  (nps  save  floppy  NO  &&,  getdiskQ  <  2)  return; 

0  ifdefNPS_GPS 

nps_rvplot_dat8_save(d^»s_gps_oib_ins); 
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iips_rvplot_daU_save(&spas _gps_orb_jp8); 

nps_rvplot_d«U_s»ve(&orb_gps_orb_ins); 

nps_rvplot_d*U_save(&spas_gps_orb_tgt); 

nps_diflpIol_<Uta_save(iu)rb_»wtooth): 

nps_difiplot_daU_nve(&tgt_8awtooth); 

nps  rvplot_d*U  save(&orfa  tgt  orfa  gps); 

#  endlfNPS_GPS~ 

nps_rvplot_daU_8tve(&orb_tgt_orb_iiis); 


void  nps_systein_stopO 

{ 

#  ifdefNPS_GPS 

nps_rvp!ot_data_stop(&spas_gps_orb_ins); 
nps_rvplot_data_stop(&sp«s_gps_orb .jps); 
nps_rvplot_data_stop(&orb_gps_orb_ins); 

nps_rvplot_data_stop(&spas_gps _ orb_tgt); 

nps_difiplot_data_stop(&orb_sawtooth); 
nps_diffj>lot_data_stop(&tgt_sawtooth); 
nps  rvpiot  _d«ta  stop(&orb  tgt _ ^orb_gp8); 

#  eodlf  NPS_GPS~ 

nps_rvplot _ d*- »  ’?  ^&ofb  tgt  orb  ins); 

nps_systeiSQ_sa>’»  s 


* _ */ 

int  nps  diq}lay_init(void) 

{ 

static  int  first_tinie  =  YES; 
static  char  blankQ  = 
static  char  c_test[]  =  "W"; 

/* - 

♦/ 

if  (first_time) 

{ 

int  errorcode; 

#ifdef  DEBUG 
int  xmax,  ymax; 

#aidif  DEBUG 

/* - 

♦/ 

initgraphC&gdriver,  digmode,  blank); 
if  (gdriver  =  =  CGA) 

{ 
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gdriver  *  ATT400;  gmode  »  ATT400HI; 
closegn4>h0; 

iiutgra|rii(&gdriver,  Agmode,  blank); 

} 

if  ((errorcode  ^  graphresultO)  !—  grOk) 

{ 

//closegtaphO: 

printf("Graphics  error:  %s\n'',  gn^herrormsg(errorcode)); 
pruitf(”Press  any  key  key_getO; 
return  NO; 

} 


/* - 

*/ 

getviewsettings(&nps_gra|ducs_info.  main_view); 

#ifdef  DEBUG 
closegraphO; 

xmax  —  nps _jraphics_info.nudn_view.right  +  1; 
nps_gn4>hics_info.main_view.right  s  edit_integer(*xmax  ?  xmax)  -  1; 
ymax  ^  nps_gn^hics_info.main_view.bottom  -f  1; 
npsjgr^>hics_info,main_view.bottom  -  edit_integer(''ymax  ?  *,  ymax)  •  1; 
initgrapbC&gdriver,  Agmode,  blank): 

#endif  DEBUG 

nps_graphics_mfo.xmax  —  nps _grapliics_uifo.miun_view.right  +  I; 
nps_graphics_info.xmid  =  nps_gn^cs_info.xmax/2; 

nps_graphics_info.ymax  =  nps _graphics_info.main_view.bottom  +  1; 
nps_grapliics_info.yniid  »  nps_giiq>lucs_info.ymax/2; 

settextetyle(SMALL_FONT,  HORIZ_DIR,  nps_graphics_info.font_size); 
nps_grapliics_info.c_width  »  textwidth(c_test); 
nps_graplucs_info.c_height  *  textheigbt(c_test); 

:Kfdef  DEBUG 

nps_gra|diics_info.c_height  «  (intX(double)nps_gnq)lucs_info.c_beigbt  . 

*  (double)nps_graplucs_info.ymax  /  (double)yniax); 
nps_grapluc8_info.c_width  «  (int)((double)nps _grapliics_info.c_width 

*  (double)nps_gr^>hics  info.xmax  /  (double)xmax); 

#endif  DEBUG 

first_time  «  NO; 
cloaegnqriiO; 
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*/ 

nps _gra{4ucs_info.io_giiphics_iDode  »  NO; 

nps_sub_pIot  =  NPS_maiii_iiieou; 

iips_iiieou _ display_iiiitO; 

leluni  YHES; 


static  void  nps_display  gn4>hic8(int  giiq)h  mode) 

* - 1 - 1 - 1 - - 

void  nps  display_graphics(int  gr^>h_mode) 

{ 

if  (nps_sub_plot  *  =  NPS_edit_meou)  edit_screen_stopO; 
if  (graph  mode) 

{ 

if  (nps_graphics_info.ui _^graphics_mode)  return; 
initgraph(&gdriver,  &gmode,  ”*); 
nps_graphic$  info.in_graphics  mode  =  YES; 

} 

else 

( 

if (nps_graphics_uifo.m_graphics_mode  =— NO)  return; 
closegraphO; 

nps_graphics  info,  in _graphics  mode  =  NO; 

} 


void  nps  display  stopO 

{ 

nps_display _graphics(NO); 
nps_sub_pIot  =  NPS_max; 
nps  dap  on  =  NO; 

} 


*-  -  -  -  -  */ 

int  nps  bgprop(State  vector  *8v,  double  new_time,  double  input  time,  int  is_orbiter) 

{  ■  ' 

double  dt  =  new_time  -  sv->time; 

if  (prop_chk_input_time  &&  new_time  -  input_time  >  prop_max_time)  return  NO; 
if  (dt  >  prqp_max_time  1 1  dt  <  0.0)  return  NO; 
if  (dt  >  l.Oe-5) 
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{ 

aps_P.I>ng.lMllisUc_Dumber  = 

(is_orbiter  ?  ofb_baUistic_nuinber  :  sp«s_b«Ui8tic_iiuinber); 
bgprop(flv->tiiiie,  &sv->pos,  &sv->vel.  &op8_P,  dt,  prop_stq>,  &sv->pos,  &sv->vel); 
8v->tiaie  K  new  time; 

} 

return  YES; 


/*3S  S  S  I 


* - */ 

Static  void  nps_propagate_all(int  find_new  time,  double  new  time) 
{ 


/* - 

*/ 

if  (End  new  time) 

{ 

new  time  =  (orb_ins.sv.time  >  orb  tgt.sv.time  ?  orb_ins.sv.time  :  orb  tgt.sv.time); 

#  ifdef  NPS_GPS 

if  (orb_^gps.sv.time  >  new_time)  new_time  =  orb_g>s.sv.time; 
if  (spas_2ps.sv.time  >  new  time)  new  time  »  spas_^s.sv.time; 

#  endif  NPS  GPS 

} 

nps_newest_time  =  new_time; 


#  ifdef  NPS_GPS 

if  (nps_bgprop(&orb_gp8.sv,  new_time,  orb_gps.input.time,  YES)  =  =  NO) 
orb _gps.got_one  =  NO; 


if  (nps_bgprop(&spas_gps.sv,  new_time,  spas _gps. input. time,  NO)  =  =  NO) 
spas_gps.got_one  *  NO; 

#  Midif  NPS_GPS 


} 


if  (nps_bgprop(&orb_ins.sv,  new_time,  orb_ins.input.time,  YES)  s  =  NO) 
orb_ins.got_one  =  NO; 

if  (np8_bgpr(^&orb_tgt.8V,  new_time,  orb_tgt.input.time,  NO)  =  =  NO) 
orb_tgt.got_one  =  NO; 


• - */ 

static  void  nps  data  tqxiate  aU(void) 

{ 

#  ifdef  NPS_GPS 

nps_rvplot__data_update(&spa8 _gp8_orb_gps); 
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Bps  rvpiot  <hl«  upditefAipas  gp« _ orb  ins); 

Bps  ivpiot  daU jipdatftCA^s  fps_Ofb_tftt); 
nps_dif!^lot_dats_up(bte(&gt_sswtootb); 
nps_rvpIot_<lBtB_updBte(&orb _!gps_orb_ins); 
nps_difiplot_dato_iipdate(&orfo_sawtooth); 
nps  rvplot_dsU  update(&orb  tgt_ofb_gps); 
#  e«dlf  NPS_GPS” 

nps  rvpi(M_daU  iipdate(&orb  tgt_orb  ins); 

)  ■ 


l*x  S  S  S  ! 


* - ♦/ 

void  nps_d«ta_update(State_vector  '''orb_ins_in. 

Quaternion  *orb_quat_in, 

State_vector  *orb_tgt_in, 

State_vector  '*orb_gps_in, 

State_vector  *Ofb _a)8_ecef_in, 

State_vector  *spas_sv_in. 

State  vector  “"spas^^gps  in) 

{ 

double  new_tiine; 
int  show_nie,  save_ine; 

#  ifdef  NPS  GPS 

/* - 

*! 

if  (orb_8>s.  source  !=  ORB_GPS_ni50) 
orb _;gp8_in  =  oib _gps_ecef_in; 
if  (orb_gps.fix_time)  orb_H>s_in->tiine  +=  otb _gps.dtime; 

/# - 

*/ 

if  (orb_gps.in  use  &&.  orb _^gp8  in->tiine  >  orb _gps. input. time) 

{ 

if  (orb_gps.  source  !«  ORB_GPS_ni50) 

np8_wg884_to_in50(oib_gps_in,  orb_gps.«wverter,  YES); 

if  (orb_^_filter.on  ==  NO)  orb_gps.sv  =  *orb _gps_in; 
orb_gps.input  **  ♦orb _gps_in; 
orb _gps.got_one  =  YES; 

nps_filter_data_update(&orb _gp8  filter,  orb _gps_in); 

} 

if  (orb_gps  filter.on) 

{ 

if  (orb_gps_filter.auto_rerun 
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&&  <Hi>  B»  filter.next  renm  <  »  orb jgpt  filler.tnput_vector.tiiDe) 

nps_P.Drxg.b«lUstic_nuinber  «  oib_balliitic_ouii4)er, 
ops  filter_nin(&orb _gps  filter,  &orb_^n>s.sv,  &ops_P); 

} 

} 

#  endif  NPS_GPS 

/* - 

*/ 

#  ifdefNPS_GPS 

if  (spas _gps.source  !=  SPAS  spas  gps)  q)as_^_ia  ^  spas_sv_in; 
if  (spas_gps.fix_tiine)  spas_jps_in- >  time  +=  spas^gps.dtime; 

/* - 

*/ 

#  ifdef  NEW_nLTER_SPAS 

if  (^Ms  <ps.in  use  &&  spas  gps  in- >  time  >  spas_gps.  input,  time) 

{ 

if  (^Ms _gps.souice  s  as  SPAS_q)as .jps) 

np8_wgs84_to_mS0(spas_2ps_in,  spas_gps. converter,  NO); 
else  npsJ2000_to_mS(Kspas _®ps_in); 

if  (spas_gps_fUter.on  =  *=  NO)  spas .jps.sv  =  *spas .^s_in; 
apas_gps. input  ^  *'q>as_^gps_in; 
spas _^gps.got_one  =  YES; 

nps_fiiter_data  update(&spas_gps  filter,  spas _gps_in); 

} 

if  (spas _gps_filter.on) 

{ 

if  (qMS _gps_filter.auto_rerun 

&&  spas_j;ps  fiiter.next_rerun  <  =  spas jgps  filter.input  vector.time) 
{  " 

nps_P.Dnig.ballistic_number  ^  oib_ballistic_number; 
nps_filter_iun(&spas _gps_fiiter,  &spas _gp8.sv,  &nps_P); 

} 

} 

#  else 

/* - 

*/ 

if  (q>as,^gps.in  use  &&  spas_gp8_in->time  >  spas _gps.input.time) 

{ 

if  (spas _gps.source  «  =  SPAS_spas _gps) 

nps_wgs84_to_mS0(qMis _gp8_in,  spas _^.coDverter,  NO); 
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else  iip«J2000_to_iiiS0(qMt  gw  in); 

•pH _gp*.sv  «  apu  qw.input  •  **pas  ffw  in: 

*P** *  YES; 

} 

#  andif  NEW  FILTER  SPAS 

#  endif  NPS_GI*S 

/♦ - 

*1 

if  (orb_iH.fix_time)  orb_iH_in->tinie  orb_ina.dtime; 

if  (orb  uis.in  uh  AA  orb  in  in->tinie  >  orb_ins.input.tinie) 

orb_ins.sv  «  orb_ins.bput  =  *orb_ins_in; 
orb  ins.got  <»e  «  YES; 

} 

if  (orb  qiut.in_use  SlA  orb  qiuU_in*>tioie  >  orb  quat.input  time) 
{  ■ 

orb_q(Ukt.qiuU  =  *orb_qiiat_in; 
orb_quat.inptit_time  «  orb_qiutt_in->tinie; 
orb  quat.got  one  ^  YTS; 

} 

if  (orb  tgt.in  use  SiA  orb  tgt  in>>time  >  orb  tgt.input.time) 

{  ■  " 

orb_tgt.«v  =  ♦orb_tgt_in; 
orb_tgt.  input  =  '•oib_tgt_in; 
orb_tgt.got  one  »  YES; 

} 


/* - 

*/ 

new  time  «  (orb  ins_in->time  >  orb  tgt_in->time  ?  orb  ins_in*>time  :  orb  tgt_in->time); 

#  ifdefNPS_GPS  ~ 

if  (orb _gps_in->time  >  new_time)  new_time  *  orb_gps_in->time; 
if  (spH_gps_in->time  >  new  time)  new_time  »  spu _gps  in->time; 

#  endif  NPS_GPS 

/• - 

*/ 

if  (nps  sub_pIot  <  NPS  edit_menu  AA  new  time  >  prev  show  time  8ample_rate  show) 

{  ■ 

siiow_me  =  YES; 
pfev_ahow_time  new  time; 

} 

else  show_me  =  NO; 
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if  (new  time  >  prev  mve  time  -f  sample  rate  save) 

{ 

aave_me  «  YES; 

prev  save  time  *  new  time; 

else  save_me  «  NO; 

if  (save_me  « NO  StA.  8bow_me  » m  nq)  retuin; 

/* - 

*/ 

iips_propagate_aU(NO,  iiew_time); 
if  (save_me)  nps_data_update_aIIO; 
if  (sfaow_me  »  “  NO)  leturn; 

/* - 

*/ 

if  (nps_predictor.on  AA  nps_predictor.next  time  <  ^  nps  newest  time) 

{ 

nps_piedictor.oa  «  NPS_predict_iiow; 

nps_predictor.next  time  «  nps  newest  time  +  npsj>redictor.delay; 

} 

switch  (nps  sub_plot) 

{ 

case  NPS_main_meou: 

if  (nps  menu  firoao  •  »  NO)  nps_menu _ ^display  updateQ; 

break;' 

#  ifdef  NPS_GPS 

case  NPS  spas  ff)s_orb _gps: 

nps_rvpIot _ ^^splay_update(&spas _flra_orb_gps,  spas _jps_in->time,  oib_^_in->time); 

break; 

case  NPS  spas  yps_oib  ins: 

nps_rvplot ^display  update(Aspas _jps_ofb_ins,  spas _gps  in- >  time,' orb  ins  in- >  time); 

break; 

case  NPS_orb _B)s_ofb_ins: 

nps  rvplot_display  iydate(Aoib jtp8_otb  ins,  orb _gps  m->tinie,  orb  ins  in->tinie); 
break; 

case  NPS_orb_sawtooth: 

nps_difiplot_display_ttpdate(&orb_sawto(^,  orb_gps_m->time,  orb_ins_in->tinie); 
break; 
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am  NPS_ipM ^fp»_oib  tft; 

qM  rvplot_diqriiy  lydn^tows  «pi  <»fa  ttt.  ipas  gw  iii->tiine,  orb_tgt_ui- > time); 
brnk; 

case  NPS_tft_nwtoolfa: 

ope  di^lM_dupky_update(&tft_nwtoodi,  apu _^gpe_m->tiiiie,  orb_tgt_in- >  time); 
bnik; 

ease  NPS_orb_tjt_orb  gpt: 

iipa_rvplot _ diaplay  update(Aoffa  tgt  orb jgp*,  orb_tgt_in->time,  orb _gp8_ii>*>time); 

bra^; 

#  eadif  NPS_GPS 

caae  NPS_oib_tgt_ofb_iiia: 

npa_fvpIot_diaplay_updale(&oib_tgt_ofb_ina,  orb_tgt_in-  >  time,  orb_in8_m-  >  time); 
tweak; 

#  ifdef  NPS_GPS 

caae  NFS  orb  gpa  pitch  yaw: 

if  (spaa_fpa.got_oiie  A  otbjgp8.gotjooe  A  orb_qiiat.got_ODe) 

np8_pypIot__dtaplay_iipdate(&orb_gp8_py,  Aapaa _gps.sv,  &orb jgps.sv, 
Aofb_quat.quat,  apaa _gpa_iii->time,  orb _gp8_iii->time); 

break; 

caae  NPS_orb_ina_apas _jBM_pitch _yaw: 

if  (orb_iiis.got_oae  A  apaa_gps.got_oiie  A  orb_quat.got_oiie) 

npa_pyplot _ ^diaplay_update(&otb_ina_8pa8 jH>s_py,  Aapas _gps.8v, 

&orb_iiis.av,  &^_quat.qiiat,  qwa _gpa_in->time,  orb_iii8_m->time); 
break; 

#  eodif  NPS_GPS 

case  NPS_orb_iiis_pitch _yaw: 

if  (orb_tgt.got_oiie  A  orb_ins.got_one  A  orb_quat.got_one) 

nps_pyplot _ diaplay_update(&otb_iiis_py.  &orb_tgt.sv,  &orb_ms.sv, 

&oib_quat.quat,  orb_tgt_ui->time,  orb_ins_m->time); 

break; 

definilt;  break; 


if  (npsjwedictor.oa  »»  NPSjnedict  now)  npsjiredictor.on  ^  NPS_predict  on; 

} 


/* 


*. 


■*/ 


void  iqMi_data  fludiO 

{ 
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#  ifiiefNPS_GPS 

apt  filtor_data  fliiafa(Aorb _fp«  filter); 

#  ififef  NEW_FIUrai^SPAS 

ape  filter_data  flushfA^Ms _jpe  filter); 

#  eadlfNEW  FILTER  ^AS 

#  eadtf  NPSjGPS 

#  ifdefNPS_GPS 

spas _^gps.iBput.tiiiie  s 
orb _gps.ioput.tiine  * 

#  eadif  NPS_GPS 
orb_ias.iaput.tiioe  « 
orb_quat.ioput_tiiiie  = 
piev_show_tiiiie  » 
prev_save_tiine  *  0.0; 

#  ifdefNPS_GPS 

aps  rvpiot  data  fluahfAapaa  gp8_oib^B>8); 
aps_rvplot_data_flush(AqMS_gps_orb_iB8); 

aps_fvplot _ data_flush(Aorb  gps_oib  ins): 

aps_rvplot__<iata_fluah(Aspas  gps_orb  tqt); 
ops_dif)plot_data_flu8h(Aofb_iawtootli); 

Bps  diflplot  data  flush(At£t  sawtooth); 
aps  rvplot  data  flush(Aorb  tgt  orb  gps); 

»  endlf  NPS_GPS" 

ops  rvplot_data  flu8h(&orb  tgt_orb  ins); 

}  " 


* - - - */ 

static  void  nps_dala_flush_one(int  plot) 

{ 

switch  (plot) 

{ 

#  ifdefNPS_GPS 

case  NPS_spas _gp8_orb _gps: 

ops  rvplot_data  flushfA^MU _gps__o>^ 
break; 

case  NPS_q>a8  gps  orfa  ias; 

op8_rvpiot_data_flu8h(Aspas_gps_orb_ins); 

Ineak; 

case  NPS_oib _Jps__oib_ins: 

iq)s_rvplot_data_fliish(Aoib _gps_oib_ins); 
tweak; 

case  NPS_oib_sawtoodi: 

ops  difiplot_data_fIiish(&oib_sawtootfa); 
braak; 
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caae  NPS_q>as _a»_orb_tgt; 

npt_rvplot_data  flush(&3p«s _jps_orb  tgt); 
break; 

case  NPS_tgt_sawtooth: 

nps_dil^lot_data_flush(&tgt_sawlooth); 

Ineak; 

case  NPS_orb_tgt_orb _gps: 

nps  rvpiot  data  fluah(&orb  tgt  orb  gps); 
break; 

#  eodif  NPS_GPS 

case  NPS_orb_tgt_Ofb_ins: 

nps  rvplot_data  flush(&orb_tgt_orb_in8); 
bre^; 

} 

} 


Returns: 

0  Didn’t  use  the  key 
^  1  Used  the  key 

2  Used  the  key,  My  subsystem  is  done 

int  nps  key  handler(int  key) 

{ 

int  re; 

*/ 

if  (nps_dap_on) 

{ 

if  (nps_dq)_key_handler(key)  =  =  2)  nps_diq>_on  =  NO; 
return  1; 

} 


/* - 

*1 

switch  (nps  sub_plot) 

{ 

case  NPS  main  menu: 
rc  =  NO;  " 
break; 

#  ifdefNPS_GPS 

case  NPS_q)a8 _gp»_orb _jgps: 

rc  =  nps  rvplot_k^  handler(&8pas _gps_orb _jps,  k^); 
break; 

case  NPS_q>as_^H)s_orb_ins: 

fc  =  nps_rvplot_k^_handler(&spas _gps_orb_ins,  key); 
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bfcak; 

case  NPS_orb _gps_orb_iiis: 

rc  «  nps_rvplot _ ^key_baiidler(&orb _gps_ofb_iiis,  k^); 

break; 

case  NPS_orb_aawtooth: 

rc  ^  nps_diflplot _ ^key_haiKllef<&orb_sawtooth,  key); 

break; 

case  NPS_spas _gp8_orb_tgt: 

rc  «  Dps_rvplot_key_haiidler(&q>as _ips_orb_tgt,  key); 
break; 

case  NPS_tgt_sawtooth: 

rc  B  nps_diflpIot _ key_handler(&tgt_sawtooth,  key); 

break; 

case  NPS_oib_tgt _ orb_gps: 

rc  =  nps  rvpiot _ key  handler(Aorb  tgt  orb  gps,  key); 

break; 

case  NPS  orb  gps  pitch  yaw: 

rc  =  nps_pyplot _ key_handler(&4>rb_gps_py,  key); 

break; 

case  NPS  orb  ins  spas  gps  pitch  yaw: 

rc  =  nps_pyplot_key_luiiidler(&orb_ins_spas _gps_py,  key); 
break; 

»  eodif  NPS_GPS 

case  NPS_orb_tgt _ orb_ins: 

rc  *  nps_rvpIot _ key_haiKHer(&orb_tgt _ ^orb_ins,  key); 

break; 

case  NPS_orb_iiis_pitch_yaw: 

rc  =  nps_pyplot _ ^key_handler(&orb_iiis_py,  key); 

break; 

case  NPS_edit_oienu: 

rc  =  nps_edit_tiienu_key_haiKller(key); 
break; 

default:  ic  »  NO;  break; 


/* - 

*/ 

if  (rc  >  0) 

{ 

if  (rc  *  =  2) 

{ 

nps_display _gr8phics(NO); 
nps_sub_pIot  =  NPS_oiain_iiienu; 
nps_inenu__display_init0; 

} 

return  1; 
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return  ops  iiieau_k^_liaiidler(key); 

} 


R^ms: 

*  0  Didn’t  use  the  key 

■»  1  Used  die  key 

*  2  Used  the  key,  My  subsystem  is  done 

*  - *./ 

static  int  nps  menu _ k^_hsndler(int  k^) 

{ 

nps_meou_frozen  *  NO; 

switch  (k^) 

{ 

esse  KEY_esc: 

nps_dispUy_grmphics(NO); 
nps_sub_piot  =  NPS_max; 
return  2; 

#  ifdef  NPS  GPS 
case  KEYJl: 

if  (nps_sub_j>lot  *  =  NPS_spss _Rps_orb _ips)  break; 

nps_display_gr^>hics(YES); 

nps_sub_plot  =  NPS_spas _gps_orb jEps; 

nps_rvplot _ di^lay_init(&q)as_gps__orb_jps}; 

break; 

case  KEY_f2: 

if  (nps_subj>lot  =  «=  NPS_spas _gp8_orb_ins)  break; 
nps_display jfraphics(YES); 
nps_sub_plot  =  NPS_spas _gps_orb_ins; 

nps_rvplot _ ^display_init(&s|Ms _gps_orb_ins); 

break; 

case  K£Y_f3: 

if  (nps_sub_plot  =  =  NPS_orb_gps_oib_ins)  break; 

nps_diq>Iay_graphics(YES}; 

nps_sub_plot  =  NPS_orb _^gps_oib_ins; 

nps_rvplot _ ^display  init(&orb _jgps_orb_ins); 

break; 

case  KEY_shft_f3: 

if  (nps_sub_plot  —  »  NPS_oib_sawtooth)  break; 
nps_diq>Iay_gra|diics(YES); 
nps_sub_pIot  —  NPS_orb_aawtooth; 
nps_difiplot_display_init(&orb_sawtooth); 
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break; 

case  KEY_f4: 

if  (i^_sub_plot  *=  NPS_^pas_gps_orb_tgt)  break; 
nps_display _graphics(YES); 

nps_sub_plot  =  NPS  spas  gps _ ^orb_tgt; 

Dps_rvpIot _ display  initCAspasjffis  orb  tgjL); 

break; 

case  KEY_shft_f4: 

if  (nps_sub_plot  ==  NPS_igt_sawtooth)  break; 
nps_diq>iay  _gr^>hics(Y£S); 
nps_8ub_plot  =  NPS_tgt_sawtooth; 

iq3s_dif^lot _ di8play_iiiit(&tgt_sawtooth); 

break; 

case  KEY_f5; 

if  (nps_sub_plot  *  =  NPS_orb_tgt _ orb_gps)  break; 

nps_display  _graphics(YES); 
nps_sub_j>lot  =  NPS_orb_tgt_orb _gps; 

ops  ivpiot _ di^iay  ioit(&orb  tgt _ orb _gps); 

breii; 

0  endif  NPS_GPS 
case  ICEY_f6: 

if  (nps_sub_pIot  *  =  NPS_orb_tgt _ orb_ins)  break; 

Dps_display_grq>hics(YES); 

nps_subj)Iot  =  NPS_orb_tgt _ orb_ins; 

nps_rvplot _ ^display  init(&orb_tgt _ ^orb_ins); 

break; 

case  KEY_f7: 

if  (nps_sub_plot  «  =  NPS_orb_tgt _ orb_ins) 

ops  rvplot _ ^di^lay_future(&orb_tgt_orb_ins); 

#  ifdef  NPS_GPS 

else  if  (nps_sub_piot  =  *  NPS_spas .,gps_oib _gps) 
np8_rvplot_display_fimire(&^)as _gps_orb  _gps); 
else  if  (ops_sub_plot  =  *  NPS_spas_gps_orb_ms) 

nps_rvplot _ ^diq)lay_iiiture(&spas _gps_crb_ins); 

else  if  (nps_sub_piot  =  =  NPS_orb_tgt_orb _gps) 
ops  rvplot _ ^display_future(&orb_tgt_orb _gps); 

#  eodif  Nre_GPS 
break; 

case  KEY_f8: 

nps_predictor.(m  »  (nps_predictor.on  ?  NPS_predict_off  :  NPS_predict_on); 

nps_predictor.next_tiiiie'  =  0.0; 

break; 
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#  ifdef  NPS  GPS 
case  KEY_f97 

if  (nps  sub_pIot  !  **  NPS_orb_ins_pitch _yaw 
nps_subj>lot  ! «  NPS_orb_gpsj)itch _yaw 
&&  nps_sub_plot  !=  NPS_orb_ins_spas_gps_pitch _yaw)  break; 

if  (np8_py_plot  »  =  NPS_orb_gps_pitch _yaw) 

nps_py_plot  =  NPS_orb_ins_8pas_gpsj)itch _yaw; 
else  if  (nps_pyj)lot  »  *  NPS_orb_ins_^)as _gps _pitch_yaw) 
nps_py_plot  =  NPS_orb_ins_pitcb _yaw; 
else  nps_py_plot  *  NPS_orb_gps_pitcb _yaw; 

#  endif  NPS_GPS 

case  KEY_alt_f5: 

if  (nps_sub_plot  *  =  nps_py_plot)  break; 
nps_display _gn4ihics(YTS); 
nps  sub_plot  ~  nps_py_plot; 

#  ifde?  NPS_GPS 

nps_pyplot _ display_init( 

(nps_py_plot  ==  NPS_orb_gps_pitch _yaw 
?  &orb_jps_py 

:  (nps_py_plot  *=  NPS_orb_insjpitch_yaw 
?  &orb_insj)y 
;  «&orb_ins_spas_gps_py))); 

#  else 

Dps_pyplot _ display_init(&orb_ins_py); 

#  endif  NPS_GPS 
break; 

case  KEY_alt_f6: 

if  (nps_sub_plot  =  =  NPS_orb_tgt _ ^orb_in5) 

nps_pyplot _ display_sUts(&orb_ins_py,  &orb_tgt.sv, 

&orb_ins.sv,  ^rb_quat.quat); 

#  ifdef  NPS_GPS 

else  if  (nps_sub_plot  =  =  NPS_spas_gps_orb _gps) 

nps_pyplot _ display_sUts(&orb_gps_py ,  &spas_gps.  sv , 

&orb_gps.sv,  &orb_quat.qiiat}: 

else  if  (nps_sub_pIot  =  =  NPS_spas_gps_orb_ins) 

nps_pyplot _ ^display_stats(dwrb_ins _py,  Aspas _gps.sv, 

&orb_ins.sv,  ilco^_quat.quat); 

else  if  (np8_8Ub_plot  *  =  NPS  orb  tgt  orb _gps) 

nps_pyplot_display_stats(«Scorb _gpsj)y,  dkorb  tgt.sv, 
&orb_gps.sv,  &orb_quat.quat); 

#  endif  NPS_GPS 
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bnsak; 

cue  KEY_«lt_f7: 

nps_daU_fliuh_one(nps_sub_plot): 

lMe«k; 

case  KEY_alt_l8: 
nps  data  flushO: 
break; 

case  KEY_aIt_flO: 
nps_systein_uveO; 
break; 

ifdef  NPS_GPS 
case  KEY_cntl_fl: 

if  (orb  gps  filter,  liny  fill!  =  *  NO)  break; 
orb_gps_filter.on  =  Y^; 

ops_P.Drag.ballistic_number  =  ofb_ballisttc_number; 
nps_filter_run(&orb_gps_filter,  &orb_gps.sv,  &nps_P); 
break; 

case  KEY_cntI_f2: 

orb_gps_filter.on  =  NO; 
break; 

ifdef  NEW_nLTER^SPAS 
case  KEY_cntl_f3: 

if  (sfua _gps_filter.ring_fiill  =  =  NO)  break; 
spu _gps_filter.on  =  YES; 

nps_P.I>rag.ballistic_iiumber  =  spu_ballistic_number; 
nps_filter_niii(&^iu _^s_filter,  &spu _gps.sv,  &nps_P); 
break; 

case  KEY_cntl_f4; 

spu _gps_filter.on  =  NO; 
break; 

endif  NEW_HLTER  SPAS 
endif  NPS_GPS 

cau  KEY_cntl_f6: 
cau  KEY_cntl_f7: 

if  (nps_sub_pIot  =  =  NPS  orb  tgt_orb  ins)  ops  (kq>_plot  =  &orb  tgt_orb_ins; 
ifdef  NPS_GPS 

elu  if  (nps_sub_piot  =  s  NPS_q>u .Jps_orb _gps)  nps_diq)_pIot  =  &q>u _gps_orb_gps; 
elw  if  (np8_sub_plot  **  *=  NPS_q>u _gps_orb_ins)  nps_diq>_plot  =  &spu_gps_orb_ins; 

elu  if  (nps  sub_piot  =  *  NPS  otb_tgt_orb  gps)  nps_dap_plot  *  &orb_tgt _ ^orb  gps; 

aidif  NPsJgPS 
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elie  break; 

if  (key  -»  KEY_ciiU  f7) 

{ 

nps_dap_on  »  YES; 
nps  di4>_display  initO; 

} 

else  nps_mdv _ initO; 

bleak; 

case  KEY_cntl_f8: 

nps_piedictor.timistl.on  =  NO; 
break; 

case  KEY_cnU_f9: 

aps_propagate_all(YES,  0.0); 
if  (nps_newest_tinie  >  prev_save_tiine) 

{ 

prev_save_tinie  =  nps_newest_time; 
nps  data  update  allO; 

} 

break; 

case  KEY_flO: 

if  (nps_subjjlot  ==*  NPS_edit_inenu)  break; 

nps_display_gn^bics(NO); 

nps_sub_pIot  =  NPS_edit_inenu; 

nps_edit_nienu_display_initO ; 

break; 

case  KEY_alt_fl: 

nps_menu_firozen  =  (nps_inenu_frozen  ?  NO  :  YES); 
break; 

#  ifdef  NPS_SIM 
default: 

return  NO;  //  NOTE  do  not  leave  this  in  FLIGHT  version 

#  endifNPS  SIM 

} 

retuni  YES; 


* _ <♦/ 

static  void  nps  menu__display_init(void) 

{ 

static  char  barQ  =  "\xc4\xc4\xc4\xc4\xc4\xc4\xc4\xc4\xc4\xc4" 
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”\xc4\xc4\xc4\xc4\xc4\xc4Vxc4\xc4\xc4\xc4‘' ; 

static  Edit_label  title  labelsQ  » 

{ 

{1,1,  *Naval  Postgraduate  School  -  Plotting  Functions*  }, 

{  2,11,  *  -—-Original——*  ■'  ■  -——Propagated-—*  }, 

{  1,62,  *Vectors  in  Kit*  }, 

{  3,  1,  title_str  orb_ins  }, 

{  3,12,  *X*  },  1  4,12,  *Y*  },  {  5,12,  *Z*  },  (  6,10,  *niag*  }, 

{  9,  1,  title_str_orb  tgt  }, 

{  9,12,  *X"  },  (10,72,  *Y"  },  (11,12,  *Z*  },  (12,10,  *inag*  }, 

#  ifdef  NPS_GPS 

(15,  1,  title  str  orfa  gps  }, 

(15,12,  *X*  },  (16,12,  *Y*  },  (17,12,  *Z*  },  (18,10,  *inag*  }, 

(17,  1,  *filter*  }, 

(21,  1,  title  str  spas  }, 

(21,12,  *X*“},  722,12,  *Y*  },  (23,12,  *Z*  },  (24,10,  *mag*  }, 

#  endif  NPS_GPS 

(13,60,  bar  }, 

(14,61,  *ESC  Return  to  prev*  }, 

#  ifdef  NPS  GPS 

(16,61,  *F1  Spas/Orb  GPS  rv*  }, 

(17,61,  *F2  Spas/Orb  INS  rv*  }, 

(18,61,  "F3  OrbGPS/INS  rv*  }, 

(19,61,  *F4  Spas/Orb  TGT  rv*  }, 

(20,61,  *F5  OrbTGT/GPS  rv"  }, 

It  endif  NPS_GPS 

(21,61,  "F6  OrbTGT/INS  rv*  }, 

(23,61,  *F10  Change  Settings*  }, 

(24,61,  *Alt-Fl  Freeze  page”  }, 

(25,60,  bar  } 

}; 

#define  TITLE_LABEL_COUNT  (sizeof(title_labeis)/sizeof(Edit_label)) 

Editjabel  *Ubel; 
int  cnt; 

/K - 

*1 

clrscrO; 

for  (Isbel  *  title_labels,  cnt  =  TITLE  LABEL_COUNT;  cnt;  cnt—,  label-1- -f) 

{ 

gotoxy(label->col,  label- >  row); 
cputs(label- >  string); 
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} 

cnt  s  13; 

gotoxy(S9,  cnt);  qputaCXxtIa''); 

while  (+  +<»t  <  25)  {  gotoxy(59.  cnt);  cputsCXxbS*);  } 
gotoxy(59,  cnt);  cput«(*\xcO*); 

nps  menu_dispUy  updateQ; 

} 


S  S  1 


- Original - Propagated - 

Orb-INS  X -11111.111  -1111.111  -11111.111  -1111.111  Vectors  in  Kft 
Y-11111.111  -1111.111  -11111  111  -1111.111 
Z-11111.111  -1111.111  -11111.111  -1111.111 
mag -11111.111  -1111.111  -11111.111  -1111.111 
ddd/hh:nim:8s.sss  ddd/hfa:mm:ss.sss 

■»  ,  .  . — . - . — - . "*/ 

static  void  nps  menu  display  vec(int  row,  int  col.  Vector  *v,  char  *1100 

{ 

gotoxy(col,  row);  cprintf(fmt,  v-  >  x  *  KILOM_TO_KILOFT); 
gotoxy(col,  row+1);  cprintf(fmt,  v->y  *  KILX)M_T0_K1LX)FT); 
gotoxy(col,  row +2);  cprintf(hat,  v->z  *  KILOM_Tp_KILOFT); 
gotoxy(col,  row+3);  cprintf(fmt,  vector  magnitude(v)  *  KILOM  TO_KILOFT); 

} 

static  void  nps_menu _ ^display  sv(int  row,  int  col,  State_vector  *sv) 

{ 

static  char  fmt_posQ  =  ''%10.3r,  ftnt_velO  =  *?69.4r; 

double  tl; 
char  work[20]; 

nps_menu _ display_vec(row,  col,  &sv->pos,  fmt_pos); 

nps  menu  display  vec(row,  col+12,  &sv->vel,  fmt_vel); 

tl  =  sv->time  +  86400; 
time_dbl_to_string(&tl,  work); 
gotoxy(col+3,  row+4);  cputs(work); 

} 

sUtic  void  nps_menu_di^lay  updateQ 

{ 

iq>s_menu _ ^display_sv(  3,14,  &ofb_ins.input); 

nps_menu_display_8v(  3,36,  dtorb_ins.sv); 

nps_m6nu _ ^di8play_sv(  9,14,  &oib_tgt.input); 
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nps_iiieau_display_sv(  9,36,  &orb_tgt.sv); 

#  ifdefNPS_GPS 

nps_iiieau_dispUy_av(15,14,  Aorb  gpa.inpiU); 
np8_ioenu _ ^display_sv(lS,36,  Aorb _gpa.av); 

gotoxy(  1,18); 

if  (orb  gps  filter. ring  fall)  cputsC’RDY"); 

else  q>riiitf(*%3d'',  orb_gps_filter.Dext_saiiiple); 

gptoxy(  1,19);  cputs((orb_gps_filter.oa  ?  'ON*  ;  ’OFF*)); 
gotoxy(  5,19);  cputs((orb_gps_filter.auto_reruii  ?  "AUTO*  :  “  ")); 

nps_iiienu _ ^display_sv(2 1,14,  As|>as_gps.  input); 

nps  menu _ diq>lay_sv(21,36,  Aspas_gps.sv); 

#  endlfNPS_GPS 

} 


*  These  are  helper  routines  for  the  edit  screen  below. 

♦  _ ♦/ 

#ifdef  NPS_GPS 

static  int  Alter  rerunjHit(char  '^vork,  void  '*'dau) 

{ 

edit_fieldjput_dbl(work,  data); 

if  (''^double  ''')data  <  60.0)  ^(double  ''')data  =  60.0; 

return  YES; 

} 

Amdif  NPS_GPS 


*  This  is  the  edit-screen  for  NPS  rates  A  steps,  these  structures  must  reside 
in  this  Ale  because  they  refermce  static  variables  from  this  Ale.  These 
structures  should  be  static  exc^t  for  the  screen  structure,  which  is  used  in 
the  ops_edit_maiu  Ale. 

*  ~  ~ 

*-123456789  123456789  123456789  123456789  123456789  123456789 

*  1  San9>le  and  Stq>  Rates 

*2 

*  3  Sample  rates  (in  secs,  0  -  fut) 

*  4  plots  show:  X 

*  5  buffer  save:  X 

*6 

*  7  Orb-GPS  Alter  save:  X 

*  8  auto-rerun:  Y  rerun  delay:  X 
*9 

*10  SPAS-GPS  Alter  save:  X 
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1  auto-renin:  Y  renin  deby:  X 

*12 

*13  Step  eizB  for  prapefedon  (in  eeee):  X 
*14  Mexinniin  propegation  time  (in  eece):  X 
*1S  Teat  input  veetora  for  max-prop  time:  Y 
*16 

*17  Poaitioo  predictor  aettinga 
*18  Pbinta  to  diqilay:  X 

*19  Stq>  aize  (aeca):  X 

*20  Auto-mode  delay:  X 

* - */ 

iWfdef  NPS_GPS 

atatic  char  rate  IbllQ  »  *auto-rerun:  Y  rerun  delay:*; 

#endif  NPS_GK 

static  Edit_label  rate  labelaO  ^ 

{ 

{  1,20,  "Sample  and  Step  Rates*}, 

{  3,  4,  "Sample  rates  (in  secs,  0  ^  fost)*}, 

{  4,  6,  "plots  show:*}, 

(  5,  6,  "buffer  save:*}, 

#  ifdef  NFS  GPS 

{  7,  4,  "Oib-GPS  filter  save:*}, 

{  8,  6,  rate  Ibll}, 

#  ifdef  new" RLTER  SPAS 

{10,  4,  "SPAS-GPS  filter  save:*}, 

{11,  6,  rate  Ibll}, 

#  endif  NEW' FILTER  SPAS 
»  endif  NPS_GPS 

{13,  4,  "Step  size  for  propagation  (in  secs):  *}, 

{14,  4,  "Maximum  propagation  time  (in  secs):  *}, 

{15,  4,  "Test  input  vectors  for  noax-prop  time:  *}, 

{17,  4,  "Position  predictor  settings"}, 

{18,  6,  "Points  to  diqilay:*}, 

{19,  6,  *Stq)  size  (secs):*}, 

{20,  6,  "Auto-mode  delay:*} 

}; 

Mefine  RATE_LABEL_COUNT  (sizeof(iate_labels)/sizeof(Edit_label)) 

static  Edit  field  rate  fields}]  » 

{ 

{  4,19,  edit_fidd _get_dbl,  edit_field_put_dbl,  edit_field_key_dbl,  &sanq>le_rate_sbow  }, 

{  5,19,  edit  field ^et  dbl,  edit  fidd_put  dbl,  edit  field  key  dbl,  Asample  rate  save  }, 

#  ifdefNPS_GPS 

{  7,26,  edit_fidd  jet_dbl,  edit_fidd_put_dbl,  edit_fie]d_k^_dbl,  &orb _gps_filter.save_step  }, 
{8,18,  edit_field _get_yesno,edit_fieldjiut _yesno,edit_field_k^_yesno,&oib_gps_filter.auto_ierun  }, 
{  8,35,  edit  field _gd  dbl,  filter  rerunjnit,  edit_field_k^  dbl,  &orb_gps_filter.rerun_step  }, 

#  ifdef  NEW_FILTER3paS 
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{10,26,  edit_field edtt_fieldjpiit_dbl,  edit_ikl<l_key_dbl,  Ampu  gp«  filter.Mve  atep  }, 
{11,18,  «dit_fidd _fet  ywno,edit  field  put  yMno,odit  field  key  ye)PK>.A«PM  fpt  fUter.auto  rerun 
{11,3S,  edit  field _jel  dU,  filter  ienn_piit,  edit  field_key  i&l,  Aapes _gpt  filter.rerun  step  }, 

#  eiidifNEW>ILTER~SPAS 

#  codifNPSjOPS 

{13,41,  edit_field .jet_dbl,  edit_fieldjiut_dbl,  edit_field_k^_dbl,  &prop_atep  }, 

{14,41,  edit_field _jet_dbl,  edit_field_put_dbl,  edit_fiefal_k^_dbl,  }• 

{13,42,  edit_field ,^get_ye«io,edit_field_pat_yesDO,edit_field_key_yesno,  &prop_clik_iiiput_tiiDe  }, 
{18,25,  edit_field _fet_iiit,  edit_field_put_iBt,  edit_field_key_iiit,  dtiqMjpredictor.steps  }, 

{19,23,  edit_field _get_dbl,  edit_field_put_dbl,  edit_field_key_dbl,  duips_predictor.step  }, 

{20,23,  edit  field _get  dbl,  edit  field_put  dbl,  edit_field  k^_dbl,  dlEapsj>redictor.delsy  } 

}; 

Mefine  RATE_FIELD_COUNT  (nxeof(rate_fields)/si2eofi(Edit_field)) 

Edit  screen  nps  rate  screen  « 

{  ■ 

RATE  LABEL  COUNT,  rate  labels, 

RATE'hELD  COUNT,  rate  fields, 

nulC  no,  null,  null  ~ 

}; 


* 

* 


This  is  the  edit-screen  for  NPS  Perturbations,  same  conditions  as  above. 


*-123456789  123456789  123456789  123456789  123456789  123456789 


♦  1 

Propagation  Perturbations 

*2 

*3 

Drag  Mode  on:  Y 

♦4 

*5 

Ballistic  numbers 

*6 

Orbiter:  X 

*7 

Payload:  X 

*8 

*9 

Drag  Info 

*10 

Solar  Flux:  X 

*11 

Mean  Solar  Flux:  X 

*12 

Geomagnetic  Activity  Index:  X 

*13 

*14 

I^opagator  Info 

*15 

Zoiud  Harmonics:  X 

*16 
*  . 

Tesseral  Harmonics:  X 

static 

Edit_labd  pert_labelsO  ^ 

{  1,20,  "Propagation  Pnturbations*}, 
{  3,  4,  "Drag  Mode  on:"}, 

{  5,  4,  "Ballistic  numbers"}. 
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{  6,  6.  -Oibiler’}, 

{  7,  6.  -Pfcykwd:-}, 

{  9,  4,  *Dnig  InfinuMtioo*}, 

{  10.  6.  'Solar  Flux:*}. 

{  II.  6.  'Mean  Solar  Flux:'}. 

{  12.  6.  'Geomagnatic  Activity  Index:*}. 

{  14.  4.  'Propagator  Infbrmatioa*}. 

{  15.  6.  'Zonal  Harmonies:'}. 

{  16.  6.  'Tesseral  Hannonics:'} 

}; 

Mefine  PERT_LABEL_COUNT  (si2eof(pert_labels)/si2ieof(Edit_labei)) 


static  Edit  field  pert_fieldsQ  = 

{ 


{  3.18,  edit_field _gct_yesno,  edit  field_put  yesno,  edit_field_key_yesno,  &nps_P. Drag. mode  }, 


{  6,15,  edit_field _get_dbl,  edit_field_put_dbl. 
{  7,15,  edit_field _get_dbl,  edit_field_put_dbl, 
{  10,18,  edit_field_get_dbl,  edit_fieldj)ut_dbl, 
{  11,23,  edit  fidd_get_dbl,  edit  field_put  dbl, 
{  12,34,  ediffidd _get_dbl.  ediffieldjuirdbl. 
{  15,23,  edit_fidd _get_int,  edit_fiddj>ut_int, 

{  16,26,  edit_field _g^_int,  edit_field_put_int. 


edit_field_key_dbl,  du>rb_bdlistic_number  }, 
edit_field_key_dbl,  &spas_bdlistic_number  }, 
edit_field_key_dbl,  &nps_P.Drag.solar_flux  }, 
edit_fidd_key_dbl,  &nps_P.Drag.mean_solar_flux  }, 
edit_fidd_k^_dbl,  &nps_P.Drag.roean_solar_flux  }, 
edit_fidd_kty_int,  &itys_P.Gravity.number_zonal  }, 
edit_field_key_int,  &aps_P.Gravity.number_tesseral  } 


}; 

^define  PERT_FlELD^COUNT  (si2eof(pert_fields)/sizeof(Edit_fidd)) 


Edit  screen  npsjpert  screen 

{ 

PERT  LABEL  COUNT,  pert  labels. 
pert" RELoJcOUNT,  pert  fields, 

nulC  no,  null,  null 

}; 


/*■ 


*  These  are  helper  rxMitines  for  the  edit  screoi  below. 

♦  - ♦/ 

static  Nps_state_vector_info  sv_temp; 

static  void  state_vector  scde(State  vector  *v,  double  scale) 

{ 

v->pos.x  scde;  v->pos.y  •=  scde;  v->pos.z  scde; 
v->vel.x  scde;  v->vel.y  •»  scde;  v->vd.z  ♦=  scde; 

} 

static  void  sv_pre_scieen(Edit  screen  ^screen) 

{  ■  . 

Nps_state_vector_info  =  (Nps_state_vector_info  '*')screen->data; 
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if  (gv  mm  Aorb  ins) 

{ 

screen- >labels[0].string  m  "Orbiter  Inertial  State  Vector*; 

) 

else  if  (sv  mm  Suxb  tgt) 

{ 

screen- >  labels[0].string  m  "Orbiter  Target  State  Vector*; 

} 

#  ifdefNPS_GPS 

else  if  (sv  mm  Aspas _gpa) 

{ 

screen- >  labels[0].atring  »  *Spas  GPS  State  Vector*; 
screen- >Iabela[101.stting  m 
*SouTce  for  SPAS  vector  (0  SPAS-GPS,  1  SPAS-SV):*; 

} 

else  /*  sv  SB  =  &orb_gp8  */ 

{ 

screen- >labels{0].string  =  *Orbiter  GPS  State  Vector*; 
screen- >labels[10].atring  m 

*Source  for  GPS  vector  (0  GPS-MSO,  I  GPS-WGS84):*; 

} 

#  endifNPS_GPS 
8v_tenip  “ 

state  vector  8cale(&sv  tenqj.sv,  KILOM  TO  KIIXIFT): 

static  void  svjpost  screen(Edit  screea  'Screen) 

Nps_8tate_vector_info  =  (Nps_state_vector_info  '•')screen->data; 

if  (screen- >  changed  ==  NO)  return; 

if  ((sv->in_use  se  sv  temp.in  use)  ==  NO) 

{ 

state_vector_scale(&sv_ten^».sv,  KILOFT_TO_KILOM); 
sv->sv  SB  sv_tenip.sv; 
sv->got_one  =  YES; 

} 

if  ((sv->fix_tiine  ss  sv_teinp.fix_tiine)  =*  YES) 
sv->dtiine  m  sv_temp.dtime; 

#  ifdefNPS_GPS 

if  (sv  mm  Stspas _gps) 

{ 

if  (8V_tenq>.source  <  SPAS_src_nHa)  spas _gps.source  m  sv_tenq>.source; 
strcpy(title_rtr_spas,  title_str_spas_8rc[spas _a>s.source]); 

if  (sv_teii4>.convefter  <  NPS_M50_cnv_niax)  spas _gp8.convcrter  *  sv_tenip. converter; 


nps.c 


nps.c 


} 

else  if  (sv  »  «  &oib _n>«) 

{ 

if  (sv_teiiip. source  <  ORB_GPS_src_mex)  orb  gps. source  »  sv_teaip.source; 
if  (sv_teinp.coDverter  <  NPS  M50  cnv  msx)  orb _gps.conv«ter  sv  teD^>.converter; 

} 

#  eodifNPS  GPS 

} 


*  This  is  the  edit-screen  for  the  State  Vectors,  «»nie  conditions  as  above. 

* 

■*•--123456789  123456789  123456789  123456789  123456789  123456789 
■*■  1  ORBITER  STATE  VECTOR 

*2 

*  3  Position  x:  X 

■*4  Kft  y:  X 

■*■5  r  X 

■*6 

■*■  7  Velocity  x:  X 
■*■  8  Kft/s  y:  X 

■•■9  z:  X 

■•10 

■•11  Tune  (ddd/hh:inin:ss):  DDD/HH:MM:SS.SSS 
■•12 

■•13  Use  Realtime  Vector:  Y 
■•14 

■•15  Apply  time  correction:  Y  (delta  in  secs):  X 
■•16 

■•17  Source  for  SPAS  vector  (0  SPAS-GPS,  1  SPAS-SV):  X 
■•18 

■•19  Converter  for  WGS84-MS0  (0  iload  file,  1  computed):  X 

♦  - */ 

static  Edit_label  sv_labels[]  = 

{ 

{  1,20,  NULL}, 

{  3,  4,  "Position  x:*}, 

{  4,  7,  "Kft  y:"}, 

{  5,13,  "z:"}, 

{  7,  4,  "Velocity  x:"}, 

{  8,7,  "Kft/s  y:"}, 

{  9,13,  "z:"}, 

{  11,  4,  "Time  (dddftih:mm:ss):"}, 

{  13,  4,  "Use  Realtime  Vector:"}, 

{  15,  4,  "Apply  time  correction:  Y  (delta  in  secs):  X"}, 

{  17,  4,  NULL}, 

{  19,  4,  "Ccmverter  for  WGS84-M50  (0  iload  file,  1  computed):"}. 
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fdefiBe  SV_LABEL_COUNT  (sizeof(sv_labeIs)/sizeofCEdit_Ubel)) 


static  Edit  field  sv  fieldsQ  » 

{ 


{  3,16.  edit 
j  4,16,  edit 
{  S,16,  edit 
{  7,16,  edit 
{  8,16,  edit 
{  9,16,  edit 
{11,25,  edit 
{13,25,  edit 
{15,27,  edit 
{15,47,  edit 
{17,52,  edit 
{19,56,  edit 


field _iet_dbl, 
fidd j;et_dW, 
field _|^_dbl, 
field _get_dbl, 
field_get_dbl. 


edit_field_put_dbl , 
edit_field_put_dbl , 
edit_fiddjHit_dbl, 
edit_field_put_dbl , 
edit_field_put_dbl. 


edit_fie]d_key_dbl , 
edit_field_key_dbl, 
edit_field_key_dbl, 
edit_field_key_dbl , 
edit_field_key_dbl, 
t_field jet_dbl,  edit_field_put_dbl,  edit_field_k^_dbl, 
field _get_dhinsl,edit_field_put_dhios],edit_field_k^_dluns,  &sv_temp.sv.tiiiie  }, 
field _get_yesno,edit_field_]mt_yesno,edit_fidd_key_yesno,&sv_temp.in_use  }, 
field _get _yesno,edit_field_put_yesno,edit_field_key_yesDO,&sv_teiiip.fix_tiiiie  }, 
field _get_dbl,  edit_fieldj>ut_dbl,  edit_field_key_dbl,  &sv_temp.dtiine  }, 
field _get_int,  edit_field_j>ut_bt,  edit_field_key_int,  &sv_teiiip.  source  }, 
field _get_iiit,  edit_field_put_int,  edit_field_key_int,  &sv_teitq>.converter  } 


dc5v_teinp.sv.pos.x  }, 
&sv_teinp.sv.pos.y  }, 
&sv_teiiip.sv.pos.z  }, 
&sv_teiDf>.sv.vel.x  }, 
&av_teiiip.sv.vel.y  }, 
&sv_teiiip.sv.vel.z  }, 


}; 

#define  SV_nELD_COUNT  (sizeof(sv_fields)/sizeof(Edit_field)) 


Edit  screen  nps_orfo  ins  sv  screm  — 

SV  LABEL  COUNT  -  2,  sv  labels, 

SV_nELD_COUNT  -  2,  svjields, 

(void  *)&orb  ins,  NO,  sv_pre  screen,  sv_post  screen 

■ 


Edit  screen  nps  orb  tgt  sv  screen  — 

{  ‘ 

SV_LABEL_COUNT  -  2,  svjabels, 
SV_nELD_COUNT  -  2,  sv_fields, 

(void  *)&orb_tgt,  NO,  sv_pre_screen,  sv_post_screen 

}; 


#ifdef  NPS_GPS 

Edit_screai  nps  spas_gps  sv  screen  = 

{ 

SV  LABEL  COUNT,  sv  labels, 

SV^nELDjcOUNT,  sv_fields, 

(void  *)ScMp»sjgps,  NO,  svjire  screoi,  svjx>st_screen 

}; 


Edit  screen  nps_orb_^gps  sv  screen  = 

{  " 

SV_LABEL  COUNT,  svjabels, 

SV_FIELD JCOUNT,  sv  fields, 

(void  *)&orb _gps,  NO,  sv_pre  screen,  sv_post_screen 

}; 


npa.c 


npa.c 


feadif  NPS_GPS 


nps.c 
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* - - ♦/ 

#ifiidef_NPS 
fdefine  NPS 


#iaclude  <8tdlib.h> 
4^liide  <gnphics.h> 

finclude  <vector.h> 
iKnclude  <k^i.h> 
finclude  <orbmechl.b> 
(Include  <emin.h> 

finclude  <nps_if.h> 


extern  int 

nps_nienu _ key_lMndier(int), 

nps_bgprop(State_vector  *8v,  double  new_time,  double  input_tinie,  int  is_orbiter); 
extern  void 

nps_nienu _ ^di^lay_init(void), 

nps_menu_dispUy_update(void), 
np8_display_gr^>hics(int  graph_niode); 

extern  int 

nps_edit_nienu_key_bandler(int); 
extern  void 

nps_edit_nienu_display_init(void); 
extern  int 

nps_dap_key_handler(int); 
extern  void 

nps_dq)_display_init(void), 
nps_mdv _ init(void); 


Only  one  of  these  structures  will  exist,  it  will  be  globally  visible,  and 
*  it  will  have  the  same  name  as  the  type  (but  all  lower  case). 

The  xmax/ymax  members  will  be  the  number  of  pixels,  not  the  largest  valid 
pixel.  For  exanq>le,  if  the  screen  is  640  pixels  wide,  then  xmax  will  be  640, 
not  639  (which  is  the  largest  valid  x*pixel). 

.  .  <■/ 

typedef  struct 

{ 

struct  viewporttype  main_view; 
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int  xmax,  xmid,  c_width: 
int  ymax,  ymid,  c_height; 
iot  foiit_8ize,  in _gnphics_aK>de,  page; 

}  Nps _grapliics_info; 

typedef  struct  {  double  origin,  range;  }  Nps_plot_axis; 

enum  nps_axis  {  NPS_axis_X,  NPS_axis_Y,  NPS_axis_Z  }; 

typedef  struct 

{ 

char  "litle,  *target_title,  '*^haser_titie; 

Nps_plot_axis  axis[3]; 
int  axis_vert,  axis_horz; 

}  Nps_plot_info; 

typedef  struct  {  int  id;  char  '*'text;  }  Nps_label; 
typedef  struct  {  char  pattem[24];  }  Nps_log_file_header; 

/* - *! 

extern  void 

nps_plot _ vlabels(int  x,  int  y,  int  ystep,  Npsjabel  ♦label,  int  cnt), 

nps_plot _ ^clear_view(struct  viewporttype  *view,  int  outline), 

nps_plot _ set_view(struct  viewporttype  "View,  int  outibe), 

nps_plot _ inain_view(void), 

nps_menuplot _ init(char  ♦♦strings); 

extern  int 

nps_p)ot _ next_page(void) ; 


/♦= 


♦  These  structures  help  organize  all  the  information  known  about  a  given 

♦  state-vector  or  quaternion. 

♦  - */ 

typedef  struct 

{ 

int  in_use,  got_one,  source,  converter,  fix_time; 
double  dtime; 

State_vector  input,  sv; 

}  Nps_state_vector_info; 

typedef  struct 

{ 

int  in_use,  jjOt_(Mie; 
double  input_tinie; 

Quaternion  quat; 

}  Nps_quatemion_info; 


nps.h 


apm.h 


*  All  thrusts  are  in  km/s,  just  like  all  the  other  vectors. 

*  - */ 

typedef  struct 

{ 

int  on,  delayed,  injvlh; 
double  time; 

Vector  dv_body; 

}  Nps_piedictor_tlmi8t; 

enum  nps_predictor_state  {  NPS_predict_off,  NPS_predict_on,  NPSj)redict_now  }; 

typedef  struct 

{ 

int  on,  steps; 

double  stq},  delay,  next_time; 

Perturbations  ‘*t>erts; 

Nps_quateniion_info  *q_btoi; 

Nps_predictor_thrust  thrustl; 

}  Nps_predictor; 

extern  int 

nps  predictor  thrust(Nps  predictor  *predictor,  State_vector  ♦chaser), 

nps_predictor _ mdv(Nps_predictor  •predictor, 

State_vector  *target,  State_vector  *chaser, 
double  ttr); 


-*/ 


enum  nps_rv_type  {  NPS_rvplot_rv,  NPS_rvplot_hv,  NPS_rvplot_ih  }; 

typedef  struct 

Nps_plot_info  display; 

RV_vector  *ring_buffer; 

ushort  ring_max,  prev_sample,  next_sampie,  ring_full; 


char  •••menu_list; 

int  m«u_id,  bbar_on,  plot_type; 

char  ♦log_file_name; 

Nps_log_file_header  *log_file_hdr; 

Emm_handle  emm; 

Nps_state_vector_info  *target,  •chaser; 

Nps_predictor  •predictor; 
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Vector  last_fvdot; 
double  crossing_time; 

}  Nps_rvplot_iiifo; 

I*. - - - - */ 

extern  int 

nps  rvpiot  data  init(Nps  rvplot  info  *info, 

ushort  nux_niem,  ushort  c(Mifig_mem,  Einm_info  ^mm), 
nps_rvplot _ key_luuidler(Nps_rvplot_mfo  "Hnfo,  int  key); 

extern  void 
nps_rvpIot 
nps_rvplot 
nps_rvpIot 
nps_rvpIot 
nps_rvpIot 
nps_rvplot 
nps_rvplot 
nps_rvplot 

extern  void 

nps_rvplot _ init(Nps_plot_info  '•info,  RV_vector  '•'prev.  Vector  '''prev_rvdot, 

char  '^'•'nienu,  int  type,  int  hbar,  ushort  bnaax,  ushort  bent), 

nps_rvplot _ time(double  tl,  double  t2), 

nps_rvplot_values(double  x,  double  y,  double  z,  double  dist, 
double  closure,  ushort  bent), 

nps_rvplot _ ^hbarfdouble  y,  double  ydot,  double  crossingjime), 

nps_rvplot _ point(Nps_plot_info  "'info.  Vector  "'pos, 

double  tl,  double  t2,  ushort  bent. 

Vector  "'rvdot,  double  crossing  time), 
nps  rvplot  point  fastCNps  plot  info  "info.  Vector  "'pos), 

nps_rvplot _ point_text(Nps_plot_info  "'info.  Vector  "'pos,  char  "text,  int  bright), 

nps_rvplot_mdv(Nps_plot_info  "info.  Vector  "tndv_dv,  double  mdv  dist); 


_data_stop(Nps_rvplot_info  "info), 

_data_save(Nps_rvplot_info  "info), 
data_flusb(Nps_rvplot_info  "info), 
display_init(Nps_rvplot_info  "'info), 

dispiay_update(Nps_rvplot_info  "'info,  double  ttime,  double  ctime), 
data_update(Nps_rvplot_bfo  "info), 
display_iuture(Nps_rvplot_info  "info), 
niMiu_off(Nps_rvplot_info  "info); 


* - */ 

enum  nps_diff_type  {  NPS_diff_pos,  NPS_diff_vel  }; 

lypedef  struct  {  double  diif[2],  time;  }  Diff_vector, 

typedef  struct 

{ 

Nps_plot_info  displays[2]; 

Diff_vector  "iing_buffer; 

ushort  ring_max,  prev_sanq>le,  next_sainple,  ring_iull; 
double  begin_time; 

char  ""'"'inMiu_list; 
int  nienu_id,  active_piot; 
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char  '*log_fUe_iuuiie; 

Nps_Iog_file_header  •log_file_hdr; 

Kmm  handle  raiio; 

Nps_state_vector_tnfo  ^target,  ^chaser; 

}  Nps_diffpIot_iiifo; 

/* - */ 

exton  int 

nps  diflplot  data  InitfNps  difiplot  info  *info. 

uahort  niax_inein,  uahoit  config_mein,  Emm_info  ^emin), 
nps_difipIot _ key_handler(Nps_diffplot_uifo  *info,  int  key); 

extern  void 
nps_dif!fplot_ 
nps_difiplot 
nps_diffplot_ 

Dps_difi^lot, 
nps_diflj)iot. 
nps_diflplot 

extern  void 

nps_diffplot _ init(Npsjilot_info  *info,  int  diff_typc,  char  ’•’^menu), 

nps_diff^lot_time(double  tl,  double  t2), 

nps_difI^iot _ ^values(double  diff,  double  dtime,  int  difr_Qrpe), 

ops  diffplot  point(Np8  plot  info  *info,  double  diff,  double  dtime, 
int  diff_Q^,  double  tl,  double  t2), 

nps  diffplot  point  fastfNps  plot  info  '*4nfo,  double  diff,  double  dtime); 


.data_stop(Nps_difi^lot_info  ♦info), 

.data_8ave(Nps_dif^lot_info  ♦info), 

.data_flush(Nps_di^iot_info  ♦info), 

,di^iay_init(Nps_diffjplot_info  ♦info), 

.display_update(Nps_diffplot_info  ♦info,  double  ttime,  double  ctime), 
data_update(Np8_dif!plot_info  ♦info); 


■* - */ 

typedef  struct 

{ 

char  ♦title,  ♦target_title,  ♦chaser_title,  '"'menu; 

}  Nps_pyplot_iofo; 

/* - •/ 

extern  mt 

nps_pyplot_key_handler(Nps_pyplot_info  ♦info,  int  key); 
extern  void 

nps_pyplot _ ^display_init(Nps_pyp)ot_info  "info), 

nps_pyplot _ ^disq>lay_update(Nps_pyplot_info  ♦info, 

State_vector  ''laiget,  State_vector  ♦orbiter. 
Quaternion  ♦quat,  double  ttime,  double  otime), 

nps_pyplot _ ^display_stats(Np8_pyplot_info  ♦info,  State_vector  ♦target, 

State_vector  ♦orbiter.  Quaternion  ♦quat); 
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extern  void 

np8_pyplot  iiit(Npe_pyplot_tafo  *info), 
npsj>yplot_time(double  tl,  double  t2), 

n|M_pyplot_update(Nps_pypiot_info  ^info.  Vector  ^yd.  double  tl.  double  t2), 
iips_pyplot_itets(Nps_ji|yplot_info  *info.  Vector  *pyd,  double  time), 
n]>s_pitch_yaw(Quntemion  Stete_vector  *tirget.  Sute_vector  *orb.  Vector 


/*• 


* - */ 

#deiine  NPS_HLTER_SAMPLES  60 

typedef  struct 

{ 

int  on,  auto_rerun,  input_saved; 

double  save_step,  rerun_step,  next_rerun;  ' 

Stste_vector  input_vector: 

ushort  prev  sunple,  next  sample,  ring_full; 

double  ring~bufrer[4][NFi_FILTER_SAMPLES]; 

}  Nps_filter_info; 

/* - */ 

extern  void 

nps_filter_data_flush(Nps_filter_info  ♦info), 
nps_filter_data_save(Nps_filter_info  *info), 

nps_filter_data_update(Nps_filter_info  ♦info,  Stale^vector  ♦new_vector), 
np8_filter_run(Np8_filter_info  ♦info,  State_vector  ♦out_vector.  Perturbations  ♦P); 

/*-- OLD  RLTER 

buffer  raw_orb_gps(State  vector  ♦nps_tans,  double  tans_buf[4][60],  int  tans_mat_dat[2]); 

—♦/ 

extern  int 

ls_filter(State_vector  ♦tans_in,  State_vector  ♦tans_out, 

double  tans_buf[4][60],  int  fbi,  int  point_num.  Perturbations  ♦?); 


* - */ 

typedef  struct 

{ 

double  a,  e,  Eo,  Mo,  Om,  i,  om,  n; 

}  Orbmech_classicals; 

/* - */ 

extern  void 

getclas(Vector  ♦pos.  Vector  ♦vel,  Orbmech_classicals  ♦class.  Perturbations  ♦P), 
f_and_g(Vector  ♦pos.  Vector  ♦vel.  Vector  ♦pos_new,  Vector  ♦vcl_new, 
Orbmech_cla8sicals  ♦class,  double  t_di0;  • 
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extern  double 

pbuie_croe9ing_tiiDe(State_vector  ^chaser,  State_vector  ^target.  Perturbations  '*P); 
#Biidif_NPS_ 
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14>«_d*p.C 


*. _ 

include  <Mdio.h> 

#iiiclude  <kqra.h> 
fbclude  <edit_it.b> 

#iiicliide  *nps.h” 

/fs  asssssssss 


* - */ 

extern  Nps _grapliics_info  nps _grapliic8_info: 

extern  double  nps_newest_tiine; 
extern  Nps_predictor  npsjmdictor; 
extern  Nps_rvplot_info  *nps_dap_plot; 


* - */ 

typedef  struct  {  Vector  plus,  minus;  }  Nps_dap_pair; 

typedef  struct  {  Nps_d*p_pair  x,  y,  z,  z_low;  }  Nps_d*p_iflfo; 

enum  dap_types  {  DAP_t,  DAP_b  }; 

enum  dap_«xis  {  DAP_xj>lus,  DAP_x_ininus,  DAP_z_j)lus,  DAP_z_niinus,  DAP _y_plus,  DAP _y_minus  } 
enum  dap_k^s  {  DAP_left,  DAP_up,  DAP_down,  DAP_right,  DAP_j>lus,  DAP_minus  }; 


All  DAP  thrusts  are  in  ft/sec.  X  thrusts  have  a  Z  component,  forward  jets 

*  are  9.6  degrees,  rear  Jets  are  10  degree^ 

NOHE:  the  predictor  thrust  vector  m^  be  n  km/sec,  not  ft/sec. 

*  - - */ 


static  Nps_dap_info  dap  a  = 

{ 

{ 


{ 


}. 

{ 


}. 


/*x 

*1 

{  0.056,  0.0,  0.00987}, 

/*  plus 

*/ 

{■0.056,  0.0,  0.00947} 

/*  minus 

*/ 

/*  Y 

*/ 

{  0.0,  0.056,  0.0 

}. 

/*  plus 

*/ 

{  0.0,  -0.056,  0.0 

}  /♦ 

minus  */ 

l*Z 

*! 

{  0.0,  0.0,  0.055 

}. 

plus 

*1 

{  0.0,  0.0,  -0.076 

}  /* 

minus  *! 
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/*  Z  low  ♦/ 

{  0.0,  0.0,  0.052  },  /*  frfua  */ 

i  0.0,  0.0,  -0.076  }  !*  minus  *! 

} 

}; 

static  Nps  dap  info  dap_b  » 

{ 


/*x 

♦/ 

{  0.016,  0.0,  0.00282}, 

!*  plus 

♦/ 

{  -0.016,  0.0,  0.00270  } 

/*  miniw 

♦/ 

/•  Y 

*/ 

{  0.0,  0.016,  0.0 

}. 

/<*  plus 

•/ 

{  0.0,  -0.016,  0.0 

} 

minus  '*! 

I*Z 

*/ 

{  0.0,  0.0,  0.024 

}. 

!*  plus 

{  0.0,  0.0,  -0.034 

} 

minus  */ 

/*Zlow 

*/ 

{  0.0,  0.0,  0.013 

}. 

/*  plus 

*! 

{  0.0,  0.0,-0.034 

} 

minus 

}. 

}; 


static  double  iauncb_time,  thrust_tinK_inet', 
static  int  timist_use_^t  -  NO; 
static  int  low_z_inode,  dap_type; 

static  int 

axis_counts[6], 

lvlh_key_to_axisl6]  *  {  DAP_x_plus,  DAP_z_niinus,  DAP_z_plus,  DAP_x_minus,  DAP __yjf>lus, 
DAP_y_niinus  }, 

body_key_to_axis[6]  =  {  DAP_z_plus,  DAP_x_plus,  DAP_x_minus,  DAP_z_minus,  DAP _y_p!us, 
DAP_y_minus  }, 

opposite_axis[6]  =  {  DAP_x_ininus,  DAP_x_plus,  DAP_z_ininus,  DAP_z_plus,  DAP _y_ininus, 
DAP_yjjlus  }; 

static  double  time_to_radv  «  60.0  *  60.0;  //  60  min 


* - *! 

static  struct 

{ 

struct  viewporttype  view; 

int  height,  Iinel_y,  line2_y; 

int  (h^_x,  mode_xl,  mode_x2,  mode_x3; 

int  bar_xl,  keysl_xl,  keysl_x2; 
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int  bw_x2,  data_xl,  data_x2: 

mt  bu'_x3.  k^>2_xl,  k^s2_x2,  k^a2_x3,  keyt2_x4; 

int  a_leagth,  a_heigbt,  pjength,  p_hNght: 

}  menu; 


* - ♦/ 

static  void  points  init(void) 

{ 

int  xmax  •  nps ,^(rapiucs_info.xinax: 
int  ymax  *  nps _grapiiics_info.yniax; 
int  c_width  »  nps _f^^>hics_info.c_width; 
int  c_hei^t  =  nps_gfaphic8_info.c_height: 

/* - 

*1 

menu.  view,  left  —  0; 
menu.view.right  »  xmax  -  1; 

«ifdef  DEBUG 

menu.view.top  »  ymax  -  1  -  (menu.height  ^  c_lwight  *  4); 

#dse 

menu.view.top  ^  ymax  •  1  •  (menu.height  «  c  height  *  3  •  c  hmght/4); 
#endif  DEBUG 

menu.view.bottom  —  ymax  •  1; 
menu.view.clip  =  Y^; 

meau.linel_y  —  c_height  •  c_height/4: 

menu.line2_y  =  menu.linel_y  +  c__height  +  c_height/4; 

/* - 

♦/ 

menu.dap_x  «  c_width; 
m«iu.mode_xl  »  c_width  2; 
menu.mode_x2  »  menu.mode_xl  +  c_width  7; 
menu.mode_x3  ^  menu.mode_x2  +  c_width  *  8; 

/♦ - 

*1 

menu.bar_xl  «  xmax  *  0.21; 
menu.keysl_xl  »  menu.bar_xl  +  c_width; 
menu.keysl_x2  menu.k^sl_xl  +  c_width*S; 

/* - 

*/ 

meou.bar_x2  «  xmax  *  0.42; 
meou.data_xl  «  menu.bar_x2  +  c_width; 
menu.data_x2  —  meau.data_xl  -f  c_width  2; 

menu.a_Iength  »  c_height  c_height/2; 
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iiie(iu.pjeiigth  »  3; 
iiieau.p_bejght  »  meou-pjength; 
iiieau.a_heigbt  inaiu.p_leiigtb  *  2; 

/* - 

*! 

iiieau.iNU'_x3  »  xmaix  *  0.56; 

iiieau.k^s2_xl  »  ineiiu.bar_x3  +  c_wuhh; 
iiieDU.k^s2_x2  »  aienu.key82_xl  •¥  c_widtb  12; 

inenu.keys2_x3  iiieau.k^s2_x2  +  c_width  10; 

menu.k^s2_x4  «  iiieou.k^s2_x3  +  c_width  *  12; 

} 

static  void  draw_aiTOw(int  x,  int  y,  int  a  xdt,  int  a_ydt) 

{ 

nK>veto(x,  y); 

linerel(  a_xdt  *  menu.ajeagth,  a_ydt  menu.ajength); 
liiierel(-(a_xdt  *  menu.pjength  +  a_ydt  *'  nienu.p_beight). 

-(a_ydt  *  menu.pjength  •¥  a_xdt  *  aienu.p_hei^t)); 
iineiel(a_ydt  ^  menu.a_height,  a_xdt  *  menu.a_height); 
linefel(a_xdt  *  menu.pjength  -  a_ydt  *  menu.p_height, 
a_ydt  menu.pjength  •  a_xdt  *  menu.p_height); 


void  nps  <hqi_menu(void) 

{ 

static  char 

axis_label[4][4]  =  {  *+X",  "-X".  '+Z%  "-Z’  }. 
fmtlD  =  •%s%2d  %s"; 

Vector  dv_ft; 
char  work[24]; 
int  X,  y,  ’''key_map,  axis; 

/* - 

*1 

settextstyIe(SMALL_FONT,  HORIZ_DIR,  nps_jtnq>hics_info.font_size}; 

iettextju8tify(LEFT_TEXT,CENTER_TEJn^; 

np8_plot _ ^clear_view(&menu.view,  YES); 

/* - 

*! 

outtext]^(menu.di4>_x,  menu.Iinel_y,  ((hq)_type  ?  *DAP-B"  :  "DAP-A")); 
outtextxy(menu.mode_xl,  mmiu.line2_y,  "Modes;”); 
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if  (iip*_pradietor.dinHtl  .delayed) 

outtextxy(iiienu.iiiode_]^.  ineau.liiie2_y,  "Delayed*); 
if  (npsjmdictor.dmistl.injvlh) 

outtext]^(iiieau.inode_x2,  iiienu.Iiiiel_y,  "in-LVLH*); 
if  (Iow_z_iiio^) 

outtextxy(menu.iiiode_x3,  iiKou.Uiie2_y,  "low-Z"); 


/* - 

*/ 

liiie(iiieou.bar_xl.  0,  iDenu.t>ar_xl,  menu.beight): 

outtextxy(inenu.keysl_x2,  ineau.Iiiiel_y,  "ESC,  SPACE,  Z,L"); 
outtextxy(oieou.k^sl_x2,  iiieau.line2_y,  "A,B,  ENTER  +  -*); 

X  s  menu. keys l_xl;  y  «  nienu.line2_y;  dnw_am>w(x,y,  0,-1); 

X  +  s  nienu.a_height;  y -s  menu.ajength;  draw_aiTow(x,y,  0,  I); 
y  +3S  nieou.aJeagth; 

X  -i-s  nienu.p_height-t'2;  y  nienu.p_height:  dnw_aiTow(x,y,  1,  0); 

X  -t-s  menu.ajength;  y  menu.a_height;  dnw_^aiTow(x,y,  -1,  0); 

/* - 

*/ 

line(menu.tMU’_x2,  0,  menu.bar_x2,  maiu.height); 

dv_ft.x  =  nps_predictor.thrustl.dv_body.x  *  KILOM_TO_FT; 
dv_ft.2  =  nps_predictor.thnistl.dv_body.z  *  KILOM^TO_FT; 

sprintf(woik,  *%9.6ir,  dv_ft.x): 
outtextxy(menu.data_xl,  menu.linel_y,  "X:"); 
outtextxy(menu.daU»_x2,  menu.linel_y,  work); 

q>rintf(wotk,  "%9.6lf',  dv_ft.2); 
outtextxy(menu.data_xl,  menu.luie2_y,  *Z:"); 
outtextxy(m«iu.data_x2,  menu.line2_y,  work); 

/* - 

*/ 

liDe(menu.bar_x3,  0,  menu.bar_x3,  menu.height); 

outtextxy(menu.keys2_xl,  menu.lme2_y, 

(nps_predictor.thrustl.inJvUi  7  "(LVLH)*  :  "(Body)*)); 

k^_map  »  (nps_predictor.tlmistl.inJvUi  7  lvlh_key_to_axis  :  body_key_to_axis); 

X  s  menu.key82_xl  +  menu.ajength;  y  =  meau.Imel_y; 
draw_anow(x,y,  -1,  0); 
axis  s  k^_map[DAPJeft]; 

8printf(woik,  ftntl,  axlsjabel[axis],  axis_counts[axis],  "out"); 
outtextxy(X'f4,  m«iu.lmel_y,  work); 
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X  s  aieau.k^i2_x2;  y  «  aienu.Uiiel_y  +  iBeiiu.aJeBgth/2  +  2; 
dniw_«rrow(x,y,  0,-1); 
axis  «  k^_inap(DAP_iip]; 

spriiitf(work,  fimtl,  axis_label[axis],  axis_couiits(axis].  ’up*); 
outtextxy(x-f  S,  iDeau.liiiel_y,  work); 

X  s  inenu.keyt2_x2;  y  «  nienu.liiie2_y  -  meQu.a_Iength/2  -  2; 
dimw_aiTow(x,y,  0,  1); 
axis  »  k^_map[DAP_downl; 

q}rintf(work,  fmtl,  axis_label[axis],  axis_counts{axis],  ‘down’); 
outtextxyCx+S,  menu.Iine2_y,  work); 

X  »  meou.keys2_x3;  y  »  iiieau.liiiel_y; 
draw_arrow(x,y,  1,0); 
axis  =  key_iiiap[DAP_right]; 

sprintfCwork,  fimtl,  axis_label[axis],  axis_coiiots[axis],  ‘in'); 
outtextxy(x-i-4+iiienu.a_la>gth,  menu. line l_y,  work); 

if  (nps_predictor.thrustl.in_Ivlh  ==  NO) 

I 

X  s=  meou.keys2_x4; 

outtextxy(x,  nienu.linel_y,  "Labels  valid*); 
outtextxy(x,  nienu.line2__y,  "for  pitch  90*); 

} 

npsjplot _ main  viewQ; 

} 


- */ 

void  nps_dap_display_iiiitO 

{ 

if  (menu,  height  =  =  0)  points  initQ; 

nps_rvplot_menu_off(np8_dq)_plot); 

nps_dap_menu0; 


void  nps  dap_clear(int  new  type) 

{ 

nps_predictor.t)mistl.on  ^  NO; 
nps_predictor.thrustl.dv_body.x  = 
nps_predictor.thrustl.dv_body.y  = 
nps_predictor.tlirustl.dv_body.z  -  0.0; 

axis_counts[DAP_x_plus]  = 
axis_counts[DAP_x_niinus]  = 
axis_counts[DAP_y_plu8]  = 
axis_counts[DAP_j'_minus]  * 


axia_counta[DAP_zjpliis]  » 
•xis_counta[DAP_z_iniaus]  *  0; 

dap  type  B  new  type; 

} 


/*» 


Returns: 

0  Didn’t  use  the  key 

1  Used  the  key 

2  Used  the  key.  My  subsystem  is  done 

♦ - ♦/ 

mt  nps  dap_key_handler(int  key) 

{ 

int  axis,  opp_axis,  sign; 

Nps_di4>_info 
Vector  *dv; 

/* - 

*/ 

switch  (key) 

{ 

case  KEY_esc: 

nps_rvplot _ di^]ay_init(nps_dapjilot); 

return  2; 

case  K£Y_space: 

nps_dap_clear(dap_type); 

nps_rvplot _ ^display_init(nps_dap_plot); 

nps_dap_nienuO; 
return  YES; 

case  KEY_cr: 

nps_rvplot _ ^dispiay_future(nps_dap_plot); 

nps_dap_nienuO; 
return  YES; 

case  ’Z’: 
case  ’z’: 

low_z_nK)de  =  (low_z_iiiode  ?  NO  :  YES); 

nps_diq>_inenuO; 

return  YES; 

case  ’L’: 
case 

nps_predictor.thnistl.in_IvIh  —  (nps_predictor.  thrust! 

nps_dap_menuO; 

return  YES; 
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c«ae  ’A’: 
case  V: 

if(dap_type  !*  DAP_a)  {  nps_«iap_clear(DAP_a);  nps_dap_iiienuO;  } 
returo 

case  ’B’: 
case  ’b’: 

if  (dap_type  !  *  DAP_b)  {  nps_dap_clear(DAP_b);  Dps_dap_inenuO;  } 
return  YK; 

case  KEY_up:  key  =  DAP_up;  break; 
case  K£Y_(iown:  key  DAP_dowa;  break; 
case  KEY_left:  key  s  DAPJeft;  break; 
case  KEY_right:  key  ^  DAP_right;  break; 
case  key  —  DAP_iainus;  break; 

case  '  +  key  -  DAP_plus;  break; 

default:  return  YES; 


/* - - 

*  Check  if  there  have  been  pulses  in  the  opposite  direction.  If  so  then 
we'I)  use  the  opposite  key  and  sutraci  delta-v,  otherwise  we  want  to  use 

*  this  key  and  add  delta-v. 

*/ 

axis  =  (nps_predictor.thrustl.in_lvlh  ?  lvlh_key_to_axis  ;  body_key_to_axis)(key]; 
opp_axis  =  opposite_axis[axis]; 

if  (axis_counts[opp_axis])  {  sign  =  -I;  axis  =  opp_axis;  } 
else  sign  =  1; 

I* - 

*/ 

axis_counts[axis]  sign; 

dap  =s  (dap_type  »  *=  DAP_a  7  &dap_a  :  &dap_b); 

switch  (axis) 

{ 

case  DAP_x_pius:  dv  «  &diq>->x.plus;  break; 
case  DAP_x_niinus:  dv  —  &di^>->x. minus;  break; 

case  DAP_z_plus:  dv  =  (low_z_niode  ?  &di^)->z_low.plus  :  &dap->z.pius};  break; 
case  DAP_z_ininus:  dv  =  (low_z_niode  ?  &di^>z_low.  minus  :  &dap->z.  minus);  break; 
case  DAP_y_plus:  dv  —  &dr^>->y.plus;  break; 
case  DAP_y  minus:  dv  «  &dap->y.niinus;  break; 

} 


/*- 

*/ 
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nps_predictor.thnistl.dv_body.x  +=  dv->x  "■  FT_TO_KILOM  *  sign; 
nps_predictor.thrustl.dv_body.y  +=  dv->y  *  FT_TO_KILOM  *  sign; 
nps_predictor. thrust l.dv_body.z  +=  dv->z  *  FT_TO_KILOM  *  sign; 
nps_predictor.thrustl.on  s  YES; 

nps_rvplot _ display_iuture(nps_dap_plot); 

nps_di4>_menu0; 

return  YES; 

} 

♦ - */ 

void  nps_mdv _ initO 

{ 

jHfdef  NPS_RNDV 

nps_piedictor_mUv(&nps_predictor,  &nps_dap_plot-  >  target-  >  sv , 
&nps_(hq>_plot-  >  chaiicr-  >  sv,  tinie_to_mdv); 

nps_rvplot _ ^disptay_future(nps_dap_pIot); 

#endif  NPS_RNDV 

} 


sUtic  int  edit  field_get  dbl9(char  *work,  void  *data) 

{ 

sprintf(work,  "%9.61f',  *(double  ''‘)data); 
return  -1; 

} 

static  int  edit_field_get_dbl5(char  *work,  void  "'data) 

{ 

sprintf(work,  "%5.2ir,  "‘(double  "‘)data); 
return  -1; 

} 


"■—0123456789  123456789  123456789  123456789  ’3456789  123456789  123456789  123456789 
"*  I  Thrust  information  (ft/s) 

*2 

*  3  X-con^  Z-comp 

"■4  DAP-A  +xup  -0.000000  -0.000000  10  deg  pitch 

"‘5  -X  down  -0.000000  -0.000(X)0  9.6  deg  pitch 

"•6  -bzout  -0.000000  -by -0.000000 

*1  -z  in  -0.000000  -y  -0.000000 

"■  8  (low-z)  +z  out  -0.000000 

*9  -z  in  -0.000000 


*10 

*11  DAP-B  +xup  -0.000000  -0.000000 

*12  -xdown  -0.000000  -0.000000 

*13  -t-zout  -0.000000  -t-y -0.000000 

*14  -z  in  -0.000000  -y  -0.000000 

*15  (low-z)  -f  z  out  -0.000000 

*16  -z  in  -0.000000 

*17 

*18  Future  thrust:  Y  Note:  future  thrusts  use  the  current  attitude, 

*19  GMT-L  DDD/HH:MM:SS.SSS  so  answers  are  valid  only  during  inertial  hold, 

*20  +  MET  DDD/HH:MM:SS.SSS  the  alternative  is  to  apply  thrust  in  LVLH 

*21  or  GMT  DDD/HH:MM:SS.SSS  Y 
*22 

*23  Thrust:  etubled:  Y  TTR  (NO  whole  orbit  intervals!) 

*24  in  LVLH:  Y  DDD/HH:MM:SS.SSS 

*25  (XYZ):  -0.00  -0.00  -0.00 

* - */ 

static  char 

lbl_xp[]  =  ’'-^x  up", 
lbI_xmD  =  "-X  down", 

ibij^pn  =  ■'+y". 

Ibl_ymD  =  "-y", 
lbl_zpD  =  "-»-zout", 

Ibl  zin(]  =  "-Z  in", 

IbfzlD  =  "(low-z)"; 

static  Edit  label  thrust  labelsQ  ~ 

{ 

{  1,18,  "Thrust  information  (ft/s)"}, 
j  3,20,  "X-comp  Z-comp"}, 

{  4,  1,  "DAP-A"}, 

{  4,  9,  lbl_xp},  {  5,  9,  lbl_xm}, 

{  6,  9,  Ibl_zp},  {  7,  9,  Ibl  zm}, 

{  6,49,  Ibl _yp},  {  7,49,  IbT 
{  8,  9,  lbl_zp},  {  9,  9,  lbl_zin},  {  8,  1,  lbl_zl}, 

{  4,42,  "10  deg  pitch"},  {  5,42,  "9.6  deg  pitch"}, 

{11,  1,  "DAP-B"}, 

{11,  9,  lbl_xp},  {12,  9,  Ibl  xm}, 

{13,  9,  Ibl  zp},  {14,  9,  Ibl  zm}, 

{13,49,  Ibfyp},  {14,49,  IbT^m}, 

{15,  9,  Ibl_zp},  {16,  9,  lbl_zm},  {15,  1,  lbl_zl}, 

{18,  1,  "Future  thrust:"}, 

{19,  2,  "GMT-L"}, 

{20,  2,  "-I-  MET"}, 

{21,  2,  "or  GMT"}, 


{18,27,  "Note:  future  thrusts  use  the  current  attitude,"}. 
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{19,29,  *80  answers  are  valid  only  during  inertial  hold,*}, 
{20,29,  *tbe  alternative  is  to  apply  thrust  in  LVLH*}, 


{23,  1,  *Thnist:  oiabled:*}, 

{24,  9,  *in  LVLH:*}, 

{25,  1,  *(XYZ):-}, 
iWfdef  NPS_RNDV 

{23,44,  *TrR  (NO  whole  orbit  intervals!)*} 

#endif  NPS_RNDV 

}: 

#define  THRUST_LABEL_COUNT  (sizeof(thrustJabcl8)/sizeof{Edit_label)) 


static  Edit_field  thrust  fieldsQ 

{ 

{  4,18,  edit_field_get_dbl9, 
{  4,30,  edit_field_get_dbl9, 
{5,18,  edit_field_get_dbl9, 
{  5,30,  edit_field_get_dbl9, 
{  6,30,  edit_field_get_dbl9, 
{  7,30,  edit  field_get_dbl9, 
{  8,30,  edirfield_get  dbI9, 
{  9,30,  edirfield_get“dbl9, 
{  6,52,  edit  field_get  dbl9, 
{  7,52,  edirfield_gerdbl9. 


edit_field_put_dbl , 
edit_field_put_dbl, 
edit_fieldjput_dbl, 
edit_field jput_dbl , 
edit_field_put_dbl , 
edit_field_put_dbl, 
edit_field_put_dbl, 
edit_field_put_dbl , 
edit_field_put_dbl, 
edit_field_put_dbl. 


edit_field_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl , 


{11,18,  edit_field_get_dbl9,  edit_field_put_dbl, 
{11,30,  edit_field_get_dbl9,  edit_field_put_dbl, 
{12,18,  edit_field_get_dbl9,  edit_field_put_dbl, 
{12,30,  edit_field_get_dbl9,  edit_field_put_dbl, 
{13,30,  edit_field_get_dbl9,  edit_field_put_dbl, 
{14,30,  edit_field_get_dbl9,  edit_field_put_dbl, 
{15,30,  edit_field _get_dbl9,  edit_field_put_dbl, 
{16,30,  edit_field_get_dbl9,  edit_field_put_dbl, 
{13,52,  edit_field_get_dbl9,  edit_field_put_dbl, 
{14,52,  edit_field_get_dbl9,  edit_field_put_dbl. 


edit_field_key_dbl , 
edit_field_key_dbl , 
edit_ficld_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl, 
edit_fie!d_key_dbl , 
edit_field_key_dbl , 
edit_field_key_dbl, 
edit_field_key_dbl , 
edit_field_key_dbl , 


dulap  a.x.plus.x  }, 
&dsp_a.x.plus.z  }, 
&dap_a.x.minus.x  }, 
&dap_a.x.minus.z  }, 
&dap_a.z.plus.z  }, 
&dap_a.z. minus. z  }, 
Sulap_a.z_low.plus.z  }, 
&dap_a.zJow.mlnus.z  }, 
&dap_a.y.plus.y  }, 
&dap_a.y.minus.y  }, 

&dap_b.x.plus.x  }, 
&dap_b.x.plus.z  }, 
&dap_b.x.minus.x  }, 
&dap_b.x.minus.z  }, 
&dap_b.z.plus.z  }, 
&dap_b.z. minus. z  }, 
&dap_b.z_low.plus.z  }, 
&dap_b.z_low.minus.z  }, 
&dap_b.y.plus.y  }, 
&dap_b.y.minus.y  }, 


{18,16,  edit_field_get_yesno,edit_field_put_yesno,edit_field_key_yesno,&nps_predictor.thrustl. delayed  }, 
{19,  9,  edit_field_get_dhmsO,edit_field_put_dhmsO,edit_field_key_dhms,  &launcb_time  }, 

{20,  9,  edit_field_get_dhmsO,edit_field_put_dhmsO,edit_field_key_dhms,  &thnist_time_met  }, 

{21,  9,  edit_field _get_dhmsl,edit_field_put_dhmsl,edit_field_key_dhms,  &nps_predictor. thrust  1. time  }, 
{21,26,  edit_field_get_ycsno,edit_field_put_yesno,edit_field_key_yesno,&thrust_use_gmt  } , 


{23,18,  edit_field_get_yesno,edit_fieldj)ut_yesno,edit_fieId_key_yesno,&nps_predictor.thrustl.on  }, 

{24, 18,  edit_field_get_yesno,edit_field_put_yesno,edit_field_key_yesno,&nps_predictor.thnistl  .inJvUi  }, 
{25,  9,  edit_field_get_dbl5,  edit_field_put_dbl,  edit_field_key_dbl,  &npsj3redictor.thrustl.dv_body.x  }, 
{25,16,  edit_field_get_dbl5,  edit_field_put_dbl,  edit_field_key_dbl,  &nps_predictor.thrustl.dv_body.y  }, 
{25,23,  edit_field_get_dbl5,  edit_field_put_dbl,  edit_field_key_dbl,  &ops_predictor.thrustl.dv_body.z  }, 

#ifdef  NPS_RNDV 

{24,48,  edit_field_get_dhmsO,edit_field_put_dhmsO,^it_field_key_dhms,  &time_to_mdv  } 
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#endif  NPS  RNDV 

}; 

#define  THRUST_FIELD_COUNT  (sizeof(thnist_fields)/sizeof(Edit_field)) 

* - */ 

static  void  vector_scale(Vector  double  scale) 

{ 

v->x  scale;  v->y  *=  scale;  v->z  *=  scale; 

} 

static  void  thrust_pre_screen(Edit_screen  ^screen) 

{ 

if  (nps_predictor.thrustl.time  <  nps_newest_time) 
nps_predictor.thrustl.time  =  nps_newest_time; 

vector_scale(&nps_predictor. thrust l.dv  body,  KILOM_TO_FT); 

} 

static  void  thnist_post  screen(Edit_screen  '''screen) 

{ 

if  (thrust_use_gmt) 

thrust_time_met  =  nps_predictor.  thrust  1.  time  -  iaunch_time; 

else 

nps_predictor.thrustl.time  =  launch_time  +  thrust_time_met; 

vector_scale(&ops_predictor.thrustl  .dv_body,  FT_TO_KILOM); 
if  (time  to  mdv  <  =  60.0)  time  to_mdv  =  60.0; 

Edit_screen  nps  thrust  screen  = 

{ 

THRUST_LABEL  COUNT,  thrustjabels, 

THRUST_nELD_COUNT,  thrust_fields, 

NULL,  NO,  thrust_pre_screen,  thrust_post_screen 

}; 


nps_«dlt.c 


/*s  s  s : 


* - •/ 

#iiiclude  <stdUb.h> 

#mciude  <stdio.h> 

#iiiclude  <coiiio.h> 

jKnclude  <keys.h> 

^include  <edit_rt.h> 

♦ - *f 

extern  Edit_screen 
nps_rate_screen, 
nps_pert_screen, 
nps_orb_ins_sv_screen , 
nps_orb_tgt_sv_scfeen, 

#  ifdefNPS_GPS 
nps_orb_gps_sv_scrccn , 
nps_spas_gps_sv_screen, 

#  endifNPS_GPS 
nps_thnut_screeo; 


* _ ♦/ 

static  Edit  screen  '*'screensQ  — 

{ 

&nps_rate_screen,  &nps_pert_screen, 

&nps  orb_ins_sv_screen,  &nps_orb_tgt_sv_screen, 

#  ifdeflslpSGPS 

&nps_orb  gps  sv_screen,  &nps_spas_gps_sv_screen, 
ft  endifNPS_Gre 
&nps_Umist_screen 

}; 

#define  MAX_SCREENS  (sizeof(screens)/sizeof(Edit_screen  '*')} 
static  int  cuiTent_screen; 


Returns: 

*  0  Didn’t  use  the  key 

1  Used  the  key 

2  Used  the  key.  My  subsystem  is  done 

*  - */ 

int  nps  edit_menu  key_handler(mt  key) 

{ 

int  rc  s  edit_screai_key_handIer(screen8[cuiTent_screen],  key); 
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if  (rc  >  0)  r^ura  rc; 

/• - 

*/ 

•witch  (key) 

{ 

case  KEY_pgup: 

if  (~current_screen  <  0)  cuiTeot_screea  =  MAX_SCREENS  •  1; 
break; 

case  KEY_pgcln: 

if  (+  +cuiTent_screen  >  =  MAX_SCREENS)  current_scfeeD  *  0; 
break; 

default;  return  NO; 

} 

edit_screen_iiiit(screens[current_screen]); 
return  YES; 


void  nps  edit  menu  display_initO 

{ 

edit_screen  iiut(screens[current  screen]); 

} 
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nps_filt.c 


^include  <stddef.h> 
finclude  'Dps-b* 


•*/ 


/*^SB  s  s  s  : 


- - , - _ _ _ <1/ 

void  nps  filter_data._flush(Nps  filter_info  *this) 

{ 

this->ring_ful]  =  NO; 

this- >  prev_sample  =  this->next_saiiiple  =  0; 
this->riiig_buffer(3][0]  =  0.0; 

} 

void  nps  filter  data  save(Nps  filter  info  *this) 

{ 

/* - 

*1 

if  (this->input_s8ved)  return; 

this->ring_buffer(0][this->next_saniple]  =  this->input_vector.pos.x; 
this->ring_buffer[l][thjs->next_san^)le]  =  this->input_vector.pos.y; 
this->ring_bufrer[2][this->next_sainple]  =  this->input_vcctor.pos.2; 
this-  >  ring_bufreif3][thi  s-  >  next_sainple]  =  this-  >  input_vector .  time; 

this->prev_sample  =  this->next_satnple; 
this-  >  next_sanq>]e+  + ; 

if  (this->next_sainple  >=  NPS_FILTER_SAMPLES) 

{ 

this->next_8ample  =  0; 
this->ring  full  »  YES; 

} 

this->input_saved  ^  YES; 


♦ - */ 

void  nps_filter_dcta_iq)date(Nps  filter  info  "^s,  Sute_vector  *new_vector) 

{ 

/* - 

*! 

this- >  input_saved  =  NC. 
this->input_vector  =  ''liew_vector; 
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if  (this*  >  iiiput_vector.tiiiiB  -  this-  >  ring_bufrer[3][this-  >  prev_taiiiple]  >  s  this-  >  ■ave_sl^) 
iips_fUter_dato  s«ve(this); 

} 


* - */ 

void  nps  fiJter  run(Nps  filter_iiifo  *this,  Sute_vector  *out  vector,  Peituibetions  *P) 

{ 

nps_filter_d«ta_save(this): 

l8_filter(&this->iiiput_vector,  out_vector. 
this->ring_buffer,  this->ring_fuU,  this- >  prev_s«iiple,  P); 

if  (this->auto_feruii) 

this->next_reniii  s  this- >  input  vector. time  -I-  this- >  reruD_step; 

} 
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*- . 

#iacliide  <stdio.h> 


#iiicliide  "nps.h* * 
#include  ”np8_inS0.h” 


static  State_vector_tnuisfonn  inSO_ecef; 

#define  M50_TO_WGS84  0 
#definc  WGS84 _TO_M50  1 


*/ 


■*! 


* - */ 

int  nps  wgs84_read_iload(char  ^fileiiaiiie) 

{ 

HLE  ■►iload; 

/* - 

♦/ 

if  ((iload  =  fopen(filauaiie,  "r*))  =  =  NULL)  return  NO; 
fscanf(iload,  ''%le'',  &inSO_ecef.tiine); 

in50_ecef.tiiiie  -=  86400.0;  //  Make  time  rel-secs,  like  bgpropQ 

fscanfCiload,  '^le  %Ie  %le  %Ie  %le  %le  %le  %le  %le*. 
&inS0_ecef.matrix[0][0],  &iiiS0_ecef.iDatrix[0][l],  &mS0_ecef.n)atrix[0][2], 
&tnS0_ecef.inatrix[l][01,  &mSO_ecef.matrix[I][l],  &mS0_ecef.matrix[l][2], 
&mS0_ecef.matrix[2][0],  &inS0_ecef.matrix[2][l],  &mS0_ecef.matrix[2][2]); 

fclose(iload); 

return  YES; 

} 


*  Note:  Velocity  may  be  an  inertial  velocity  expressed  in  ECEF  coordinates. 

*  Otherwise  it  is  an  ECEF  velocity,  expressed  in  ECEF  coordinates. 
- */ 

void  nps_wgs84_to  mS0(State  vector  "Vector,  int  converter,  int  vel  is_ecef) 


State_vector  mSO; 


*/ 

if  (converto’  ■  «  NPS_MSO_from_ilcMd) 

state_vecUw_ecef_lo_in50(vector,  AinSO,  JiunSO_ecef,  vel_is_eccf); 
else  if  (converter  **  NPS_MSO_coniputed) 

mS0_wgs84_niS(Kvector,  AmSO,  WGS84_TO_M50,  NULL,  vel_is_ecef); 
else  return; 

mSO.time  «  vector- >  time; 

♦vector  «  mSO; 


/♦> 


- */ 

void  nps  m50_to  wgs84(State_vector  ♦vector,  int  converter,  int  vel_is_ecef) 

{ 

State_vector  ecef; 

/* - - 

♦/ 

if  (converter  *  »  NPS_M50_flrom_iload) 

state_vector_in50_to_ecef(vector,  &ecef,  AmSO  ecef,  vel_is_ecef); 
else  if  (converter  =  =  NPS_M50_computed) 

mS0_wgs84_ni5(Kvector,  &ectf,  M50_TO_WGS84,  NULL,  vel_is_eceO; 
else  return; 

ecef.  time  =  vector- >  time; 

♦vector  =  ecef; 

} 


- */ 

void  npsJ2000_to  mSO(State_vector  ♦vector) 

{ 

State_vector  mSO; 

/* - 

♦/ 

state  vector  12000  to  m5(Kvector.  &mS0); 


mSO.time  =  vector->time; 
♦vector  =  mSO; 


■♦/ 


void  nps_m50  toJ2000(State  vector  ♦vector) 

{ 
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SUte_vector  j2000; 

/* - 

*/ 

sUle_vector_in50_toJ2000(vector,  &j2iOOO); 


j2000.tiiiie  s  vector- >  time; 
♦vector  =  j2000; 
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iq>«_a50.h 


* - ♦/ 

eoum  nps_m50_converters  {  NPS_M50_firom_iload,  NPS_MSO_computed,  NPS_M50_cnv_nuoi  }; 

/* - *! 

exteni  int 

nps_wgs84_read_iload(char  "'fileiuiiie); 
extern  void 

nps_wgs84_to_ni50(State_vector  *vector,  int  converter,  int  vel_is_ecef), 
nps_ni50_to_wgs84(State_vector  ^vector,  int  converter,  int  vel_is_ecef), 
nps_m50_toJ2000(State_vcctor  ^vector), 
npsj2000_to_m50(State_vector  ^vector); 

#endif  _NPS_M50_ 
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■* - */ 

int  nps_^stem_iiiitO  {  return  YES;  } 


int  nps_key_lundler(mt  key)  {  return  NO;  } 
int  nps_displ8y_iiiit0  {  return  NO;  } 

void  nps_d8ta_flush0  {} 
void  nps_system_stopO  {} 

void  nps_data_update(Sute_vector  '*'ort)_ins_mSO, 
Quaternion  '*nrb_quat, 
State_vector  *orb_targ_m50, 
State_vector  ♦orb_gps_ni50, 
State_vector  *orfa  gps  ecef, 
State_vector  *spas_sv_ecef. 
State  vector  *8pas_gps  ecef) 

} 
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* - */ 

void  nps_pIot_vlabels(int  x,  int  y.  int  ystqp,  Nps  label  ^iabel,  int  cot) 

{ 

for  (  ;  cnt  >  0;  cnt-,  label ++) 

outtextxy(x,  y  +  label-  >  id  *  ystep,  label-  >  text); 

} 

//int  nps_plot_nextj)ageO 

//{ 

//  return  nps_graphics  info.page  =  (nps_grapfaics  info.page  ?  0  :  1); 

* _ */ 

void  nps_plot _ clear  view(struct  viewporttype  ♦vl-w.  int  outline) 

{ 

setcoloifO); 

setviewport(view->left,  view- > top,  view- > right,  view- >  bottom,  view- >  clip); 

clearviewportO; 

setcolor(7); 

if  (outline)  rectangle(0,  0,  view- >  right  -  view- >  left,  view- > bottom  -  view- >  top); 

} 

void  nps  plot  set  viewfstruct  viewporttype  ♦view,  int  outline) 

{ 

setcolor(7); 

setviewport(view->left,  view- >  top,  view- >  right,  view- >  bottom,  view- >  clip); 
if  (outline)  rectangle(0,  0,  view- >  right  -  view- >  left,  view- >  bottom  -  view- >  top); 

} 

void  nps_plot_main_viewO 

{ 

8etviewport(nps_gnq)hics_info.main_view.left,  nps _grBphics_info.main_view.top, 
nps_graphics_info.main_view.right,  nps _gn^>hics_info.main_view.bottom, 
nps _graphics_info.main_view.clip); 

} 
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#iiiclude  <stddef.b> 
^include  <iii«th.h> 

#include  "nps.h” 


•*/ 


* - */ 

static  void  quick_prop(State_vector  '"old,  double  new  time.  Perturbations  '*'perts) 

{ 

State_  vector  new; 
double  dt; 

Orbmecb_classicals  class; 
getclas(&old->pos,  &old->vel,  declass,  perts); 

f_and_g(&old->pos,  &old->vel,  denew.pos,  denew.vel,  declass,  new_time  -  old- > time); 
new.time  —  new_time;  ‘*old  ==  new; 


* - */ 

int  nps_ptedictor_tbrust(Npsj;>redictor  ''predictor,  St8te_vector  ♦chaser) 

{ 

double  body_to_m50[3][3]; 

Vector  dv_m50; 

/* - 

*/ 

if  (predictor- >thrustl. on  *=  NO)  return  NO; 

if  (predictor- >thrustl. delayed) 

{ 

if  (predictor- >thrustl.  time  <  chaser- >  time) 

return  (predictor- > thrust  1. on  =  predictor->thrustl.delayed  =  NO); 

quick_prop(chaser,  predictor- >thrustl. time,  predictor- > perts); 

} 

if  (predictor- >  thrust  1.  in  Ivlh) 

{ 

if  (state_vector _ itol_matrix(chaser,  body_to_m50)  *  *  NO)  return  NO; 

matrix_transpose(body  to_mSO,  body  to  mSO); 

} 

else 

{ 

if  (predictor- >q_btoi->got_one  **=  NO)  return  NO; 

npsjpred.c 


npsjpr«d.c 


qtutenuon_to  iiuitrix(4S^pfedictor->q_btoi->qiuU.  body  to  iii50); 


/* - 

*f 

vector_tfiiisfonii(&pf«dictor->thnutl.dv_body,  &dv_mSO,  body_to_inSO); 

chaser->vel.x  +**  dv_mSO.x; 
chaser- >vel.y  +=  dv_m50.y; 
cbaser->vel.z  +=  dv_iii50.2; 

return  YES; 

} 


'*  The  vectors  must  already  have  matching  time  tags. 

* - */ 

#ifdef  NPS_RNDV 

int  nps_predictor_mdv(Npsjjredictor  'predictor,  State_vector  *target_in, 

State_vector  ''Phaser  in,  double  ttr) 

{ 

State_vector  target  =  *target_in; 

State_vector  chaser  =  ''^haser_in; 

double  mu  =  predictor- >perts->  Gravity .GMD.planet_mu; 

Vector  xtxvt,  hhat,  vb,  pos_dif,  ro,  rdot,  omega,  wxr_term; 

Vector  dvl_lvlh,  dvl_m50_l,  dvl_in50; 

double  mag_tpos,  mag_tvel,  magxxv,  magvbar,  lcg[3][3],  gcl[3][3]; 
double  T,  w,  delta; 

/* - 

*/ 

if  (predictor- > thrust]. delayed) 

{ 

quick_prop(&chaser,  predictor- >thrustl  .time,  predictor- >perts); 
quick_prop(&target,  predictor- >  thrust  1.  time,  predictor- >perts); 

} 


/* - 

*! 

mag_q>os  =  vector_inagnitude(&target.pos); 
mag_tvel  s  vector_magnitude(&target.vel); 

T  =  2'''n''^rt(mu*mu/(pow(2*mu/mag_q;>os  -  mag  tvel'hnag  tvel,3))); 
w  »  2*PIA'; 

/f - 

*/ 
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lcg[l](0]  «  target.pos.x  / 
lcg[l]n]  s  target.pos.y  /  nMig_4K»; 

Icg[l][2]  »  Urget.pos.z  /  iiiag_tpos; 

vector_cross(&target.pos,  &tafxcst.vel,  Axtxvt); 
magxxv  *  vector_iiuigiiitiide(&xtxvt); 

lcg[2][0]  s  hhat.x  «  xtxvt.x  /  mxgxxv; 
ics[2][Il  =  hhat.y  s  xtxvt.y  /  magxxv; 
icg[2][2]  «  hhat.z  «  xtxvt.z  /  magxxv; 

vector_cross(&target.pos,  &hhat,  &vb); 

magvbar  —  vector_magiiitude(&vb); 

lcg[0][0]  —  vb.x  /  magvbar; 
lcg[0][l]  s  vb.y  /  magvbar; 
lcg[0][2]  =  vb.z  /  magvbar; 


pos_dif.x  s  chaser.pos.x  -  target.pos.x; 
pos_dif.y  =  chaser.pos.y  •  target.pos.y; 
pos_dif.z  =  chaser.pos.z  -  target.pos.x; 


vector_traiisform(&pos_dif,  &ro,  leg); 

/♦ - 

*1 

rdot.x  *  ro.x*8in(w*ttr)  +  ro.y'''(6*w*ttr*sin(w''ttr)-i4'''(l  -  cos(w*ttr))); 
delta  =  S^w^ttr^sinCWttr)  -  -  cos(w*ttr)); 

rdot.x  /=  delta; 

rdot.y  *  ro.x+(4*idot.x-6*ro.y)*sin(Wttr)+(6*fo.y-3*rdot.x)*w'Htr; 
rdot.y  *  rdot.y/(-2)/(l-cos(w*ttr)); 
rdot.x  *=  w; 
rdot.y  *=  w; 

rdot.z  *  -ro.z^w/tanCwHtr); 

omega.x  —  0.0; 
omega.y  0.0; 
omega.z  s  w; 

vector_cross(dlu>mega,  &ro,  &wxr_term); 

dvljvlh.x  a*  rdot.x  +  wxr_term.x; 
dvl_lvlh.y  as  rdot.y  +  wxr_term.y; 
dvljvlh.z  =  rdot.z  +  wxr_term.z; 

/* - : - 

•/ 

matrix_traiiq>ose(leg,  gel); 
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v()ctor_traiisfbnii(&(lvl_lvlh,  &dvl_ni50_l,  gcl); 

dvl_iti50.x  «  tif^.vel.x  +  dvl_iii50_l.x  -  chaser. vei.x; 
dvl_in50.y  ■  target.vel.y  +  dvl_iii50_l.y  •  chaser. vel.y; 
dvl_iiiSO.z  B  target.vel.z  +  dvl_niSO_l.z  -  chaser. vel.z; 

/* - 

*1 

predictor- >thnistl  .on  «  YES; 

if  (predictor- >thru^l. in  Ivlh) 

{ 

state  vector_itol  matrix(&ehaser,  leg); 

} 

else 

{ 

quatemion_to_niatrix(d4>redictor-  >  q_btoi-  >  quat,  gcl); 
matrix  tran^>ose(gcl,  leg); 

} 

vector_transfonn(dulvl_mSO,  &predictor->thrustl.dv_body,  leg); 
return  YES; 

> 

#endif  NPS_RNDV 
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♦ _ 

#uicliide  <iiuith.h> 

iKiicliide  ”nps.h” 


•*/ 


This  function  determines  the  time  of  the  next  plane  crossing.  It  becomes 

*  increasingly  accurate  as  the  time  gets  smaller. 

*  _ */ 

double  plane  crossing_time(State_vector  "Phaser,  State_vector  *1arget.  Perturbations  *P) 

{ 

Vector  ref_sv_pos; 

C>rbmech_classicals  cias_t,  clas_c,  clas_big,  clas_sml; 
double  mu,  delOM; 

double  deli,  sin_wpnu,  cos_wpnu,  wpnu,  nul_sml,  nu2_sm),  p,  e,  n; 
double  nuo,  rl,  r2,  ro,  gl,  g2,  El,  E2,  time,  t2; 

/* - 

*! 

mu  =  P->  Gravity.  GMD.planet_mu; 

getclas(&cbaser->pos,  &chaser'>vel,  &clas_c,  P); 
getclas(&target'>pos,  &target->vel,  &clas_t,  P); 

if  (clas  c.i  <  clas  t.i) 

{ 

cla$_big  =  clas_t; 

clas_sml  =  clas_c; 

ref  sv_pos  =  chaser- >pos; 

} 

else 

{ 

clas_big  =  clas_c; 
clas_sml  =:  clas_t; 
ref  8v_pos  =  target- >pos; 

} 

(* - 

*! 

delOM  iabs(c]as_t.Om  -  clas_c.Om); 

deli  s  fBbs(cIas_t.i  -  clas_c.i); 

sin_wpou  s  8in(cIas_big.i)'''8in(delOM)/sin(deli); 

co8_wpnu  s  (cos(clas_sml.i)  -  co8(deli)‘*to8(cIas_big.i))  /sin(ddi)/sin(clas_big.i); 
wfmu  a  atan2(sin_wpnu,co8_wpnu); 

nul_sml  =  wpnu  -  clas_sml.om; 
nu2_sm]  s  nul_8ml  +  PI; 
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/* - 

*1 

p  s  clas_nnl.m*(].0  •  clas_niil.e^lui_fiiil.e); 
e  »  cIas_Miil.e; 
n  s  cUs_finI.n; 

ouo  *  2.0talMn(M]rt((l-f‘e)/(l-e))*Ua(c]as_aiii].Eo/2)); 
if  (nul_8iiil*nuo  <  0.0)  nul_s^  -f  •  2.0*I*I; 
if  (nu2_sinI-nuo  <  0.0)  nu2_tnil  +  «  2.0*n; 

rl  *  p/(1.0+e'Nx>s(nul_tiiil)); 
i2  =  p/(1.0+e*cos(nu2_aini)); 
ro  s  vector_nuigiiitude(&raf_iv_pos); 

gl  s  rl''^''^in(nul_sinl  •  nuo)/sqft(mu‘'^); 
g2  =  r2'*it)*sin(nu2_siii]  -  nuo)/9qrt(mu*p): 

El  «  2'''at«n(aqft((l*e)/(l+e))'*1ui(nul_8ixil/2)); 

E2  s  2*atan(8qrt((l-e)/(l+e))'tan(nu2_8inl/2)); 

time  =  gl  •  (8in(El  •  cla8_8inl.Eo)  -  (El  -  cl88_snil.Eo))/n; 
if  (time  <  0.0)  time  +  *  2'''PI/n; 

t2  SB  g2  '  (sin(E2  •  clas  aml.Eo)  -  (E2  •  clas  8m].Eo))/n; 
if(a<0.0)  t2+-2*PI/n; 
if  (t2  <  time)  time  >=  t2; 

/* - 

*/ 

return  time; 
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jKnchide  <iiiadi.b> 


#iiicliide  "npa-h* 


/^SB  s  s  s  as  s  s  a 


void  nps_pyplot _ ^display_update(Np8_pyplot_info  *this, 

State_vector  *Uf:get,  &ate_vector  ^torbiter, 
Quatemion  *quat,  double  t  time,  double  o_time' 

{ 

Vector  pyd; 

iips_pitch_yaw(quat,  target,  orbiter,  dqiyd); 
nps_pyplot _ update(tliis,  dlq>yd,  t_tiine,  o_tinie); 


void  nps_pyplot _ ^di8piay_stats(Nps_pyplot_info  ‘•this, 

State_vector  ^target,  State^vector  *orbiter, 
Quaternion  ^quat) 

{ 

Vector  pyd; 

nps_pitcb_yaw(quat,  target,  orbiter,  &pyd); 
nps_pyplot_8tats(tbis,  &pyd,  orbiter*  >  time); 


Returns: 

0  Didn’t  use  tbe  key 
*  1  Used  tbe  key 

'*  2  Used  tbe  key.  My  subsystem  is  done 

-  --  ■  -  _  _ 

int  np8_pyplot_k^_bandier(Nps_pyplot_info  ♦this,  int  k^) 

{ 

return  (key  » s  key  esc  ?  2  :  NO); 

} 


void  np8_pyp)ot _ ^display  tnit(Nps_pyplot  info  *this) 

{ 

nps_pyp)ot_init(dus); 

} 
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*  This  function  is  designed  to  compute  the  Pitch/Ysw  angles  from  die  orbiter 
^  to  the  target. 

* 


*  Note:  I  assume  both  state  vectors  and  the  quaternion  have  been  prcqiagated 
and  have  matching  times. 

- */ 

void  nps_pitch_yaw(Quatemion  '*q_btoi.  State  vector  '^target.  State  vector  *oib,  Vector  *t>yd) 

{ 

Quaternion  q^itob; 
double  mSO_to_body[3][3]; 

Vector  difF,  vec_to_target; 
double  rfao; 

/* - 

*/ 

q_itob  =  *q_btoi; 
quatenuon_conjugate(&q_itob): 
quatemion_to_matrix(&q_itob,  m50_to_body); 

/* - 

*! 

diff.x  “  targct->pos.x  -  orb->pos.x; 
diff.y  *  target- >pos.y  -  orb->pos.y; 
diflf.z  =  target->pos.z  -  ofb->pos.z; 

vector_transform(&difr,  &vec_to_target,  m50_to_body); 

iho  *  sqrt(vec_to_target.x  *  vec_to_target.x  +  vec_to_target.z  *  vec_to_target.z); 

pyd->x  =  atan2(-vec_to_target.z,  vec_to_target.x);  //  pitch 
pyd->y  =  atan2(vec_to_target.y,  rho);  //yaw 

pyd->z  =  vector  magnitude(&diff);  //  distance(km) 

} 
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* - */ 

iKnclude  <ttdio.h> 

#iiiclude  <inadi.h> 


iKnclude  <tiines.h> 
#iiiclude  "ops-h” 


* - */ 

extern  Nps_gTaphics_info  nps_gfaphics_info; 


*  I  use  these  structures  to  avoid  extra  floating-point  work  during  realtime. 

static  struct  pointtype  axis; 
static  int  label_y,  clear_pitcfa_yaw; 
static  double  radius  »  150.0; 

static  struct  //  Plot  times 

{ 

struct  viewporttype  view; 
int  linel_y,  linc2_y; 

}  time; 

static  struct  //  Stats  (for  other  plots) 

{ 

struct  viewportO^  view; 
int  linel_y,  line2_y,  line3_y; 

}  stats; 

static  struct  //  Pitch  info 

{ 

struct  viewporttype  view,  data_view; 
int  ceoter_x; 

struct  pointtype  view_origin,  prev; 

}  pitch; 

static  struct 

{ 

struct  viewporttype  view,  data_view; 
int  ceoter_x; 

struct  pointtype  view_ofigin,  prev; 

}y«w; 

static  struct 

{ 
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//  Yaw  mfo 


//  Distance  info 
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struct  viewporttype  data_view; 
int  center_x; 

>  dist; 


* - */ 

static  void  points  init(void) 

{ 

int  xmax  «  nps_gn^hics_info.xmax; 
mt  ymax  s  nps_gn^cs_info.ymax; 
int  xmid  =  nps _gnq^cs_info.xniid; 
int  c_width  s  nps_graphics_info.c_width: 
int  c_height  ^  nps _^graphics_info.c_height; 

/* - 

*/ 

time. view. left  »=  c_width  *  8;  //  Top  left  corner 

time.view.right  time.view.left  +  c_width  *  16; 

time.view.top  ss  c_height/8; 

time.view.bottom  =  time.view.top  -t-  c_height  3; 

time.view.clip  =  YES; 

if  (time.view.right  xmax)  time.view.right  s  xmax  •  1; 
if  (time.view.bottom  >s  ymax)  time.view.bottom  =  ymax  -  1; 

time,  line  l_y  =  c_height; 
time.line2_y  =  (c_height  *  5)/2; 

/* - 

*! 

stats.view.left  ==  c_width  ■"  3;  //  Top  left  comer 

stats.view. right  s  stats.view.left  +  c_width  *  14; 

stats. view.top  =  c_height  *  5; 

stats. view.bottom  =  stats. view.top  +  c_height  *  S; 

stats,  view.clip  =  YES; 

if  (stats. view.right  >s  xmax)  stats. view.right  =  xmax  -  1; 
if  (stats. view.bottom  >  ^  ymax)  stats. view.bottom  ^  ymax  -  1; 

stats.Iinel_y  -  c_height; 
stats.  Une2_y  =  (c_height  ■"  5)/2; 
stats.  Iine3_y  =  c_height  ♦  4; 

/♦ - 

*1 

axis.x  =  xmid; 
axis.y  s  ymax  *  0.70; 

Iabel_y  *  axis.y  +  c_beight  *  2; 

/* - 


py_plot.c 


py^plot.c 


*! 

piteh.cefiter_x  »  xmid  /  2; 

pitcb.daU_view.]eft  »  pitch.ceiiter_x  •  c_width  *  4; 
pitcb.dato_view.right  »  pitch.center_x  +  c_width  *  4; 
pitch.daU_view.top  «  hd>el_y  +  c_height; 
pitch.daU_view. bottom  *  pitcb.daU_view.top  +  c_height  *  2; 

pitch. view,  left  »  20; 
pitch. view.right  ^  axis.x  •  20; 
pitch.view.top  ^  3S; 
pitch.view.bc^m  »  axis.y  -  20; 
pitch. view.clip  *  YES; 

pitch.view_origin.x  =  (pitch.view.ri^t  -  pitch. view. left)  /  2; 
pitch.view_origin.y  ^  (pitch.view.bottom  -  pitch.view.top)  /  2; 

*J 

yaw.ceoter_x  «  xmid  4-  xmid  /  2; 
yaw.daU_view.left  =  yaw.ceater_x  -  c_width  *  4; 
yaw.daU_view.right  =  yaw.center_x  +  c_width  *  4; 
yaw.daU_view.top  =  labe!_y  +  c_height; 
yaw.daU_view. bottom  *  yaw.daU_view,top  +  c_height  "■  2; 

yaw.view.Ieft  =  axis.x  +  20; 
yaw.view.right  *  xmax  -  20; 
yaw.view.top  «  35; 
yaw.view.bottom  —  axis.y  •  20; 
yaw.view.clip  =  YES; 

yaw.view_origin.x  =  (yaw.view.right  -  yaw.view.Ieft)  /  2; 
yaw.view_origin.y  =  (yaw.view.bottom  -  yaw.view.top)  /  2; 

/* - 

*/ 

dist.ceDter_x  —  xmid; 

dist.daU_view.left  =  dist.ceQter_x  -  c_width  *  5; 
dist.daU_view. right  =  dist.center_x  +  c_width  *  5; 
dist.daU_view.t(^  **  label_y  +  c_height; 
dist.daU_view.bottom  »  dist.daU_view.top  +  c_height  2; 


* - */ 

typedef  struct  {  struct  pointtype  pi,  p2;  }  Draw_point; 
typedef  struct  {  struct  pointtype  pi;  int  al,  a2,  r;  }  Draw_arc; 

static  void  draw_pomt8(Draw_point  "this,  int  count,  int  x  origin,  int  y  origin) 

{ 

for  (  ;  count  >  0;  cmmt— ,  lhis+  +) 

line(this'>pl.x  +  x_origin,  this->pl.y  +  y_origin, 
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this->p2.x  +  X  origin,  this->p2.y  +  y_origin); 

} 

static  void  draw  arcs(I>raw  arc  *this,  int  count,  int  x_origin,  int  y_origin) 

{ 

for  ( ;  count  >  0;  count~,  this++) 

arc(this->pl.x  +  x  origin,  this- > pi. y  +  y_origm,  this- >al, this- >a2.  this->r); 

) 


♦. - */ 

static  Draw_point  pitch_pointsG  = 

{ 

{{  85,  18}, {-27.  18}},  //  bottom 

{{-33,  12}, {-IS,  -2}},  //  slant  to  canopy 

{{-10.  -7},{  0,  -7}}.  //  top 
{{  0,  -7},{  0,  0}},  //  payload  bay  (origin) 

{{  0.  0},{  65.  0}}. 

{{  65,  0},{  65.  -7}}, 

{{  65,  -7}.{  80.-27}}.  //  tail 

{{  80,-27},{  90.-27}}, 

{{  90,-27},{  85.  -7}}. 

{{  85.  -7},{  85,  18}} 

}; 

#define  PITCH_POINTS  (sizeof(pitch_points)/sizeoftDniw_point)) 

static  Draw  arc  pitch  arcsQ  s 

{ 

{{-28,  13},  170.270,5},  //nose 

{{-10,  -2},  90,180,5}  //  canopy 

}; 

^define  PITCH_ARCS  (sizeof(pitch_arcs)/sizeof(Draw_arc)) 


* _ 

static  Draw_point  yaw_pointsQ 

{ 

{{-40.  69},{-10,  72}}, 

{{-10,  72},{-10,  79}}, 

{{-10.  79}.{  10,  79}}, 

{{  10,  79},{  10.  72}}, 

{{  10.  72},{  40,  69}}. 

{{  -7,  60}.{-14.  76}}, 

{{-14,  76},{  14,  76}}. 

{{  14,  76},{  7,  60}}, 

{{  40,  69},{  40,  61}}. 

{{  40,  61},{  37,  54}}, 

{{  37.  54},{  20,  34}}. 


- */ 

//  left  wing  tip  to  eag 

II  oigines 

//  eng  to  right  tip 
//  engine  outline 

//  right  side,  Uul  to  nose 
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{{  20.  34}.{  15,  29}}. 

{{  15.  29}.{  10.  5}}. 

{{  10.  5},{  7.-25}}. 

{{  7.-25}.{  5.-31}}. 

{{  •S.-31}.{  -7.-25}}.  //  left  side,  nose  to  tail 
{{ -7.-25}.{.10.  5}}. 

{{-10.  5}.{-15.  29}}. 

{{-15.  29}.{-20,  34}}. 

{{-20,  34}.{-37.  54}}. 

{{-37.  54},{-«).  61}}. 

{{-40.  61},{-40.  69}}. 

{{  -8,  60}. {  8,  60}},  //  payload  bay 
{{-8.45}.{  8,45}}, 

{{-8.30}.{  8,30}}, 

{{  -8.  15}.{  8.  15}}. 

{{  -8,  0}.{  8.  0}}.  //  (origin) 

{{  -8.  60}.{  -8.-15}}, 

{{  8.60}.{  8,-15}} 

}; 

#define  YAW_POINTS  (sizeofi(yaw_points)/sizeof(Draw_point)) 

static  Draw  arc  yaw  arcsQ  ^ 

{ 

{{  0.-29}.  30.150,5}  //  nose 

}; 

#defuie  YAW_ARCS  (sixeof(yaw_arcs)/sizeof(Draw_arc)) 


void  nps_pyplot _ init(Nps_pyplot_info  *info) 

{ 

//  int  xmax  =  nps_gnq)hics_info.xinax; 
int  c_width  a:  nps _graphics_info.c_width; 

int  xl; 

/• - 

•/ 

if  (tiiDe.view.bottoin  «  0)  points_init0; 
cleardeviceQ; 

settextstyle(SMALL_FONT,  HORIZ_DIR,  nps_graphic8_info.font_size); 
•ettextjustify(CENT^_TEXT,CENfER_TEjd^; 

clear_pitch_yaw  «  NO; 

/* - . - 

*  Draw  the  dividers,  labels,  and  outlines. 
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*/ 

//  liiie(0,axis.y,  xnux,axis.y); 

//  Um(axis.x,0.  axi8.x.axi8.y); 

oiittextxy(pitdi.ceiiter_x,  label_y,  *Pitdi*); 
outtextxy(yaw.ceDter_x,  Ubel_y,  ‘Yaw’); 
outtextxy(axi8.x,  label_y,  "Diatance''); 

npsjilot _ ^clear_view(^itch.view,  YES); 

draw_points(pitch_poiiits,  PITCH_POINTS,  pitch. view_origin.x.  pitch. vicw_origin.y); 
dTaw_arc8(pitch_aics,  PITCH_ARCS,  pitch. view_origin.x,  pitch. view_origin.y); 
nps_pIot_iiiain_vicwO; 

Dps_plot _ ^cl6ar_view(&yaw.view,  YES); 

draw_points(yawj>oiiits,  YAW_POINTS,  yaw.view_origin.x,  yaw.view  origin.y); 
draw_arcs(yaw_arc8,  YAW_ARCS,  yaw.view_origiii.x,  yaw.view_origin.y); 
iips_plot_iiiaui_viewO; 

/* - 

*  Draw  time  labels  and  menu  bar. 

*! 

settextjustify(LEFT_TEXT,CENTER_TEXT); 
xl  =  time.view.left  -  c_width  *  8; 

outtextxy(xl,  time.view.top  +  time.linel_y,  info->target_title); 
outtextxy(xl,  time.view.top  +  time.line2_y,  info->chaser_titIe); 

nps  menuplot _ init(info->menu); 

} 


/♦=: 


* - */ 

void  nps_pyplot _ ^time(double  tl,  double  t2) 

{ 

int  c_width  ^  nps_graphics_info.c_width; 
char  work[20]; 

/♦ - 

♦/ 

np8_j>Iot_cIear_view(&time.vicw,  NO); 
8ettextju8tily(LHFT_TEXT,CENTER_TEXD; 

tl  +«  86400.0; 
time_dbl_to_string(&tl,  woric); 
outtextxy(c_width/2,  time.linel_y,  work); 

t2  +>  86400.0; 
time_dbI_to_string(&t2,  work); 
outtextxy(c_width/2,  time.lme2_y,  work); 


py^plot.c 


py_plot.c 


nps_plot _ main  viewQ; 

} 


* - */ 

void  nps_pypiot_update(Nps_pyplot_info  *info,  Vector  *pyd,  double  tl,  double  t2) 

{ 

static  char  fmt_pyD  =  -%5.ir.  fint_di8tD  =  •*6.1f  Kit*; 

int  c_width  =  nps_gra|rfiics_info.c_width; 
int  c_beight  «  nps_graphics_info.c_height; 

int  X,  y; 
char  woric[24]; 

/* - 

*  Draw  the  pitch  line,  clear  the  previous  line  first  (unless  the  plot  was 

*  just  initialized). 

*/ 

nps_plot_set_view(&pitch.view,  YTS); 

if  (clear_pitch_yaw) 

{ 

setcolor(0); 

line(pitch.view_origin.x, pitch. view_origin.y,  pitch.prev.x.pitch.prev.y); 
setcolor(7); 

} 

draw_points(pitch_points,  HTCH_POINTS,  pitch. view_origin.x,  pitch. view_origin.y); 
draw_arcs(pitch_arcs,  HTCH_ARCS,  pitch.view_origin.x,  pitch.view_origin.y); 

X  =  pitch.prev.x  =  pitch. view_origin.x  -  (intXradius  ♦  cos(pyd->x)); 
y  ss  pitch.prev.y  *  pitch. view_origin.y  -  (intXradius  *  sin(pyd->x)); 
line(pitch.view_origin.x,pitch.view_origin.y,  x,y); 

nps_plot_niain_view0; 

/* - 

Draw  the  yaw  line. 

*/ 

nps  plot  set  view(&yaw.view,  YES); 

if  (clear_pitch_yaw) 

{ 

setcoloifO); 

line(yaw. view_origin. x,yaw. view_origin.x,  yaw. prev. x,yaw. prev.y); 
setcoloif?); 

} 

drawjx>ints(yawj)oints,  KTCH_POINTS,  yaw.view_origin.x,  yaw.view_origin.y); 
draw_arcs(yaw_arcs,  I*rrCH_ARCS,  yaw.view_origin.x,  yaw.view_origin.y); 
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X  B  yaw.prev.x  »  yaw.view_origiii.x  +  (intXndius  *  sin(pyd->y)); 
y  «  yaw.prev.y  *  yaw.view_origin.y  -  (intKradius  •  cos(pyd->y)); 
Uiie(yaw.view_origin.x,yaw.view_origtii.x,  x,y); 

nps_plol_iiiain_viewO; 

/* - 

Draw  the  pitch/yaw/distance  numbers. 

*! 

settextjustily(LEFT_TEXT,CENTER_TEXT); 

nps_plol _ clear_view(d4)itch.data_view,  NO); 

qHintfi(wofk,  ftntj»y,  pyd->x  *  RAD_TO_DEG); 
outtextxy(c_width,  c_height,  work); 
nps_plot_niain_viewO; 

nps_p]ot _ clear_vtew(&yaw.data_view,  NO); 

sprintf(work,  fintjjy,  pyd->y  *  RAD_TO_DEG); 
outtextxy(c_width,  c_hetght,  work); 
nps_plot _ main_viewO; 

nps_plot _ ^clear  view(&dist.data  view,  NO); 

pyd->2  *=  KILOM_TO_iaLOFT; 

if  (pyd->z  <  1.0)  {  tet  dist(6]  =  ’  ’;  pyd->z  *=  1000.0;  } 

else  {  fmt_di8t[6]  =  ’K’;  } 

sprintf(work,  fint^dist,  pyd->z); 

outtextxy(c_width,  c_height,  work); 

nps_plot_main_view0; 

/* - 

*1 

np8j)yplot_time(tl,  t2); 
clear_pitch_yaw  —  YES; 

} 


♦ _ */ 

void  nps_pyplot_8tats(Np8_pyplot  info  *info.  Vector  *pyd,  double  time) 

{ 

static  char  fint_p0  =  "Pitch  %6.ir,  fmt_yD  =  "Yaw  586. IT; 
int  c_width  ^  nps_gr^diics_info.c_width; 
char  woik[20]; 

/* - 

*/ 

if  (stats,  view.bottom  «  «  0)  points_init0; 


py^plot.c 


pyjplot.c 


■ettex^usliiy(LEFT_TEXT,CENTER_TEXT); 

iipsj)lot_eIeu'_view(&sUts.view,  NO); 

sprintf(work,  fint_p,  iyd->x  *  RAD_TO_DEG); 
outtextxy(c_width,  staU.liiiel_y,  work); 

•priiitf(woik,  fnit_y,  pyd->y  •  RAD_TO_DEG); 
oiittextxy(c_width,  •tets.liiM2_y,  work); 

time  -fsB  86400.0; 

tiiiie_dbl_to_strmg(dUime,  work);  work[12]  •  0; 
outtextxy(c_width,  stats.liiie3_y,  work); 

nps_plot _ iiuun_viewO; 
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fiiiclude  <aUoc.h> 
#iiicliide  <iiiein.h> 
{Knclude  <io.h> 
finclude  <fcntl.h> 
(Knclude  <sUlio.h> 


#include  "nps.h” 


♦ - */ 

int  nps_rvpIot_data_init(Np8_ivplot_info  *this, 

udiort  max  mem,  ushort  config  mem,  Emm_tnfo  *emm) 

{ 

int  handle; 

NpsJog_file_header  header; 

/* - 

*  Try  to  get  EMM  memory  Erst,  and  64K  of  it.  Otherwise  use  normal  mem. 
*/ 

if  (emm_info_exists(emffl))  emm_construct_new(&this->emm,  enun,  4); 

iffenun  exists(&this->etnm)) 

{ 

char  name[10]; 

memcpyfname,  this'>Iog_Ele_iuune,  8); 
emm_name_set(&this->emm,  luune); 

this->ring_max  =  Oxffff  /  nzieofi(RV_vector); 
inax_mem  »  sizeof(RV_vector)  *  this*>ring_max; 
thls->ring_buffer  «  MK_FP(enim->|Ays.segmeots[0],  0); 

emm  map  multi(&this->emm,  EMMj|rfiy8_jMkge,  4,  emm'>map_0123); 

> 

/♦ - 

'*  Ring_max  may  already  be  initialized,  if  not  then  conqrute  it  from  the 
max_mem  argument.  Allocate  the  ring  buffer. 

*1 

else 

{ 

if  (config_mem  >  1024) 

this->ring_max  »  config_mem  /  sizeof(RV_vector); 

if  (diis'>ring_max  =»  0) 

this*>ring_max  »  max_inem  /  sizeofi(RV_vector); 
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thjs->riDs^buffN'  »  iii«lloc(iiiax_ineiii  s  sizeof(RV_vector)  *  this->ring_inax); 
if  (this*>ring_buffer  NULL)  return  NO; 


/* - 

Clear  the  ring  buffer,  and  tty  to  open  my  log-file. 

•/ 

memset(this- >  ring_bufrer,  0,  inax_mem); 

if  ((handle  =  open(this- >  log_file_name,  0_RD0NLY  1 0_BINARV))  <  0)  r^m  YES; 

/* - 

'*  Read  and  verify  the  log-file  header  pattern,  then  fill  my  ring  buffer 
from  the  file.  I  assume  all  samples  are  in  time  order  in  the  file. 

*/ 

if  (read(handle,  dcheader,  sizeof(header))  =  —  sizeof(beader) 

&&  memcmp(&header,  this- >  log  file  bdr,  sizeof(header))  =  —  0) 

{ 

this->next_sample  =  read(handle,  this->ring_^buffer,  max_mem)  /  sizeof(RV_vector); 
this- >  prev_8an4>le  =  this->next_sample  -  1; 

if  (this- >  next  sample  >=  this->ring_max) 

{ 

this->next_sample  =  0; 
this->ring  full  ^  YES; 

} 

else  if  (this->next_saii4)le  <=  0) 

this->prev  sample  »  this->next  sample  «  0; 

} 

close(handle); 
return  YES; 


* - */ 

void  nps  rvplot  data  stop(Nps  rvpiot  info  *this) 

{  ■ 

if  (emm_exist8(&thi8->emm)) 
emm  destroy(&this->emm); 

} 

void  nps  rvpiot_data  save(Nps_rvplot  info  *thi8) 

int  handle; 
ushort  size; 

/* - 
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*  Try  to  opeo/create  the  log-file.  Write  the  header  pattern. 

■»/ 

if  ((handle  ■>  opeo(this->log_file_nanie,  0_RDWR|0_BINARYiO_CREAT,  0666))  <  0)  return; 
write(handle,  dua->log^file_hdr,  sueof(Npa_log_file_header)); 

/* - 

*  I  muat  write  the  aangtles  in  time  order. 

*/ 

if  (eaim_exiats(&thia->enun)) 

emm_nMy>_inulti(&thii->emm,  EMM_phys_page,  4,  diis->enun.info->map_0123); 

if  (this-  >  ring_fiill) 

{ 

size  «  (this->ring_inax  -  this->next_saii^le)  sizeof(RV_vector); 
if  (size)  write(haodle,  diis->ring_buffer  4-  this- >  next  sample,  size); 

} 

size  «  this->next_saiq>Ie  *  sizeof(RV_vector); 
if  (size)  write(handle,  this->ring_buffer,  size); 

_write(handle,  0,  0);  //  Tnmcate  file  to  current  size 
cloae(handle); 


/♦= 


• - */ 

void  nps  rvplot_data  flush(Nps  rvplot  info  "this) 

{  ■ 

this- >  ring_ftiU  »  NO; 

this->prev_saii4)ie  -  this->next_san9>le  =  0; 


* - */ 

void  nps  rvplot_data  update(Nps  rvplot  info  *this) 

Nps_state_vector_info  ^target  »  this- >  target; 

Nps_state_vector_info  *chasm’  «  dus->  chaser; 

RV_vector  *rv  *  this->ring_buffer  +  tliis->next_Banq>ie; 

/♦ - 

*/ 

if  (target- >got_one  »»  NO  ||  diaser->got_one  NO)  return; 
if  (emm_exists(Adu8-  >  emm)) 

emm_inap_multi(&this->emm,  EMM_jdiysj)age,  4,  this->einm.info->map_0123); 
vector_rvbar(dttarget->sv,  &ehaaer->sv,  &rv->pos,  &this->last_rvdot); 
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fv->time  *  clMaer->tv.tiiiie; 

tiiis->prev_suiiple  «  tliia->iiext_naiple: 
this-  >  iiext_suiiple-f + ; 
if  (this- > next  suiq>Ie  >«  diis->ring  mu) 
( 

this->Dext_samp)e  «  0; 
this->riBg_full  »  YES; 

} 

} 


* - *•/ 

void  nps  rvpiot _ ^display  updste(Nps  rvpiot  info  *this,  double  t_time,  double  c_tiine) 

{  ■ 

Nps_stste_vector_info  ''target  »  this- >  target; 

Nps_state_vector_info  “^chaser  ^  this- >  chaser; 

Vector  pos; 

/♦ - 

*/ 

if  (target->got  one  *=*  NO  1 1  chaaer->got  one  ==  NO) 

{ 

nps_rvplot _ ^tiine(t_tinie,  c_tiine); 

return; 

) 


/f - 

*/ 

if  (this- >  predictor- >  on  ==  NPS_piedict_now)  nps_rvpIot _ ^diq;>lay_futufe(this); 

vector_rvbar(&taiget->sv,  &chaser->sv,  &pos,  &this->Iast_rvdot); 

this->crossing_tinie  *  planc_cros8ing_time(&duser->sv,  &target->sv,  this- >  predictor- >peils); 

nps  rvpiot  point(&this->  display,  &pos,  t_tune,  c^time, 

(^s->ring_full  ?  diis->ring_niu  :  this->next_8aniple), 

&this->last_rvdot,  this->crossing_tiine); 


static  void  nps_rvpIot_find  origin(Nps_plot  axis  *axis,  double  point) 

{ 

double  step  s  axis- >  range/2.0; 
int  steps; 

point  •-  KILOM_TO_KILOFT; 

if  (point  <  axis->origin  -  step)  step  «  -step; 
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if  (axis->origu  >  0  &&  axis->ori^  <>  nuige_delu) 
axis->origui  •  0.0; 
else  axis->origiii  range  delta; 

) 

elae 

{ 

if  (axis- > origin  <  0  &&  -axis->origin  <*  nnge_delta) 
axis->origiii  *  0.0; 
else  axis->origin  -f  «  range  delta; 

} 

break; 


/* - 

*1 

case  KEY_home: 

this->di!^lay.axis[NPS_axis_X].origin  - 
this- >  display. axi8[NPS_axia_Y].origin  = 
this- >  display. axis[NPS_axis_Z].origio  =  0.0; 
break; 

case  KEY_end: 

sample  —  this->ring_buffer  +  this->prev_sample; 

nps_rvplot_find_origin(dUhis- > display. axis[NPS_axis_X],  sample-  > pos.x); 

nps_rvplot _ fmd_origm(&this-  >  display .axis[NPS_axis_Y],  sample-  >  pos.y); 

nps  rvpiot _ find  origin(&this->di8play.axis[NPS  axis  Z],  sanq>le->pos.z); 

brei; 


/* - 

*1 

case  KEY_space: 

if  (this->menu_list[this->menu_id]  NULL)  tbis->menu_id  »  0; 

else  this-  >  menu_id+  -I- ; 

break; 


/* - 

*1 

case  KEY_shft_f6: 

thi8->plot_type  =  NPS_rvplot_rv; 
this- >  display. axis_vert  —  NPS_axis_Z; 
this- >  display. axis  horz  —  NPS  axis  X; 
break; 

case  KEY_shft_f7: 

this->plot_type  =  NPS_rvplot_hv; 
this- >  display. axi8_vert  »  NPS_axi8_Y; 
this- >  display. axis  horz  *  NPS  axis  X; 
break; 

case  KEY_shft_fB: 

this->plot_type  »  NPS_rvplot_rh; 
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tiiM->dupIay.axM_veit  •  NPS_a»s_Z; 
this*  >  display .uus_horz  ^  NPS_aus_Y; 
break; 

case  K£Y_sfaft_(9:  tfais*>hbar_oo  »  (this*>hbar_OD  ?  NO  :  YES);  break; 
deiault:  rc  *  NO;  break; 


/♦ - 

*! 

if  (rc  =  *  YES  Sl8l  refresh  «  *  YES)  nps_rvpiot _ ^display_init(this); 

r^um  rc; 

} 


* - */ 

void  nps  rvpiot _ display_init(Nps  rvpiot  info  '*1his) 

{  ■ 

RV_vector  ^sample; 
ushort  sanqiles; 

/• - 

*/ 

if  (einin_exists(&thi8->einm)) 

emni_niap_multi(&this->einm,  EMM_pbys_page,  4,  this*>einin.info*>inap_0123); 

sample  »  this->ruig_bufrer  +  this->prev_sampie; 

np8_rvplot _ init(&this*>  display,  sample,  &this- >  last_rvdot, 

this->menu_list[this*>meau_id],  this->plot_type,  this->hbar_on, 
this->ring_max,  (this->ring_full  ?  this->ring_max  :  this->next_sample)); 

/* - 

*  Figure  out  how  many  RV  samples  are  in  the  ring  buffer,  then  process  all 

*  the  valid  samples. 

*/ 

if  (thi8->ring_full  ««  YES)  samples  -  this->ring_max; 
else  samples  ^  this->next_sampie; 

/* - 

*/ 

for  (sanq>le  ^  diis*>ring_buf!er;  samples  >  0;  samples—,  sample++) 
nps  rvpiot _ point  fiut(&this->  display,  &sanq>ie'>pos); 

} 

void  nps_rvplot_nienu  off(Np8  rvpiot  info  "this) 

{ 

for  (this- >menu_id  *  0;  this->meau_li8t[this->meau_id]  !«  NULL;  this->menu_id+ +): 
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} 


♦ - *! 

void  ops  rvpiot _ display_future(Np8  rvpiot  info  *this) 

{  ■ 

Nps_state_vector_infb  ^target  »  this->tafget; 

Nps_stete_vector_info  *chaaer  s  this- >  chaser; 

Nps_ptedictor  ^piedictor  »  this- >  predictor; 

Ofbinech_classicals  chaser_clas,  target_clas; 
int  cnt; 

int  thrust_on,  thrust_waiting,  got_nidv_dv; 

State_vector  chaser2; 

Orbniech_classicaIs  chaser2_cla8; 
double  thnist_delay,  mdv_dist; 

Vector  mdv_dv; 

I* - 

*1 

if  (target- >got_ooe  ==  NO  jj  chaser- >got_oDe  ==  NO)  return; 
nps_rvplot _ diqf)lay_init(this); 

getclas(&chaser->sv.pos,  &chaser->sv.vel,  &chaser_clas,  predictor- >perts); 
getclas(&target->sv.pos,  &target->sv.vel,  &target_clas,  predictor- >  pens); 

/* - 

*/ 

if  (predictor- >thiustl. on) 

{ 

cha8er2  =  chaser- >sv; 

thrust_on  =  nps_predictor_thrust(predtctor,  &chaser2); 

} 

else  thnist_on  «  NO; 

if  (thrust  rat) 

{ 

getclas(&chaser2.pos,  &chaser2.vel,  &cbaser2_clas,  predictor- >perts); 
thnist_delay  =  chaser2.tiine  -  chaser- >sv.tinie; 
thnist_waiting  -  YES; 

got  mdv  dv  =  NO;  mdv  dist  »  800.0  *  FT_TO  KILOM; 

/• - 

•/ 

for  (cnt  «  1;  cnt  <■:  predictor- > steps;  cnt++)  . 

{ 
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double  dt  »  cot  *  pfedictor->stq>: 

State_vector  target_aew,  clus6r_iiew; 

Vector  rvjjXM,  rvdot; 
char  work[8]; 
double  diet; 
int  bright  *  YES; 

/* - 

*/ 

if  (cnt  <=10  II  (cnt  %  10)  =*  0)  q>rintf(work,  **d",  cnt); 

else  Mght  »  NO.  work[0]  =  ’  +  work[l]  ®  0; 

f_and_g(&chaser- > sv.pos,  &chaser->sv.vel,  &chaser_Dew.pos,  &chaser_new.vel,  &chaser_clas,  dt); 
f_and_g(&target->sv.pos,  &target->sv.vel,  &target_new.pos,  dUarget  new.vel,  &target_clas,  dt); 

vector_rvbar(&target_oew,  &cbaser_new,  &rv_pos,  &rvdot); 
nps_rvplol _ point_text(&this->diq[>lay,  &rvjx)S,  work,  bright); 

- 

*/ 

if  (thrust_oii  =  =  NO)  continue; 

if  (thrust  waiting) 

{ 

if  (dt  <  thrust_delay)  continue; 
thrust  waiting  =  NO; 

} 

if(work[01  ==’  +  ’)  work[01  =  ’o’; 


dt  thrust_delay; 

f_and_g(&chaser2.pos,  &ciuiser2.vel,  &chaser_new.pos,  &chaser_new.vel,  &chaser2_clas,  dt); 

vector  rvbar(&target_new,  &chaser_new,  &rv_pos,  &rvdot); 
nps_rvplot _ point_text(&this->  display,  &rv_pos,  work,  bright); 

/* - 

*1 

if  ((dist  =  vector_inagnitude(&rv_pos))  <  mdv  dist) 

{ 

mdv_di8t  =  dist; 
got_nidv_dv  =  YES; 

vector_diff(&chaaer  new.vel,  &target_new.vel,  &mdv  dv); 

} 


/♦ - 

*1 

if  (thnist_on  &&  got_mdv_dv) 

np8_rvplot _ mdv(&this->diq>lay,  &mdv_dv,  mdv_dist); 
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'*  I  use  these  stnictuies  to  avoid  extra  floating-pobt  woric  during  realtime. 

* - */ 

static  struct  //  Plot  times 

{ 

struct  viewpoittype  view; 
int  linel_y,  line2_y; 
int  line3_y,  line4_y; 
int  desc_color; 

}  time; 

static  struct  //  Rbar  Vbar  Hbar  numbers 

{ 

struct  viewpoittype  view; 

int  linel_y,  line2_y,  line3_y,  Une4_y,  line5__y; 

int  Iabe]_color,  value_color; 

}  rvh_bar; 

static  struct  //  Buffer  numbers 

{ 

struct  viewpoittype  view; 
int  linel_y,  Iine2_y; 

}  buffer; 

static  struct  //  Hbar  ’wander*  box 

{ 

struct  viewporttype  view; 
int  hline_xl,  hline_x2,  hline^y; 
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int  vliiie_x,  vliiie_yl,  vline_y2; 
int  ns_delU_x,  hbar_y; 
int  kft_x,  kft_yl,  kft_y2; 
int  cro3S_x,  cross_xt; 
int  is_<Hi; 

}  h_b»r  ; 

static  stnict 

{ 

int  riine_y2; 

struct  pointtype  )abel_vert,  labei_horz; 
int  label_color; 

}  axis; 

static  struct  //  Rndv  numbers 

{ 

struct  viewporttype  view; 
int  linel_y,  Iine2_y; 

}  mdv; 


* - */ 

static  int  piot^type; 

typedef  struct  //  Labels  Etc.  for  all  three  plots 

{ 


char  label_vert[5],  label_horz[5],  title[20]; 

}  My_plot_stuff; 

static  My_plot_stuff  plot_stuff[33  = 

{ 

/*  RV  *!  {  "Rbar",  "Vbar",  "View  from  the  Side"  }. 
/*  HV  */  {  "Hbar",  "Vbar",  "View  from  Below"  }, 
/*  RH  *!  {  "Rbar",  "Hbar",  "View  from  Front"  } 

}; 


^ _ _ _ _ _  _ 

Static  void  points  init(void) 

{ 

int  xmax  ^  nps _^raphics_info.xmax; 
int  ymax  s  nps _graphics_info.ymax; 
int  xmid  s  nps _giiqphics_info.xniid; 
int  ymid  *  nps _jraphics_info.ymid; 
int  c_width  »  nps_graphics_info.c_width; 
int  c_beight  =  nps _j(raphics_info.c_beigbt; 
int  c_drop  =  c_teight  +  c_height/2; 
int  xsize,  ysize; 


•*/ 
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/* - 

*! 

//  UnM.view.left  »  ximx  *  0.05;  //  Bottom  left  comer 

//  tiiiie.view.top  «  ymex  *  0.833; 

time.view.left  »  c_width  *  8;  //  Top  left  comer 

time.view.right  »  time.view.left  +  c_width  *  16; 

time.view.top  c_beight/8; 

time.view.bottom  —  Ume.view.top  -f  c_height  *  3; 

time.view.clip  »  YES; 

if  (time.view.right  >=  xmex)  time.view.right  «  xmax  -  1; 
if  (time.view.bottom  >  s  ymax)  time.view.bottom  =  ymax  -  1; 

time.lmel_y  »  c_height; 
time.lme2_y  =  time.lmel_y  +  c_drop; 
time.line3_y  =  time.lme2_y  +  c_lieight*2; 
time.line4_y  =  time.line3_y  +  c_drop; 

time.desc_color  =  11; 

/* - 

*! 

rvh_bar.view.left  =  xmax  *  0.875;  //  Bottom  right  comer 

rvh_bar.view.right  =  rvh_bar.view.left  +  c_width  14; 
rvh_bar.view.t<v  =  ymax  *  0.790; 
if  (ymax  <  480)  rvh_hu-.view.top  -=  c_height  *  2; 
rvh_bar.view.bottom  =  rvh_bar.view.top  +  c_height  *  8; 
rvh_bar.view.clip  =  YES; 

if  (rvh_bar.view.right  >=  xmax)  rvh_bar.view.right  =  xmax  -  1; 

rvh_bar.lmel_y  =  c_height; 

rvh_bar.line2_y  =  rvh_l»r.linel_y  +  c_drop; 

rvh_bar.liiic3_y  *  rvh_bar.line2_y  +  c_drop; 

rvh_bar.liiie4_y  =  rvh_bar.liiie3_y  +  c_drop; 

rvh_bar.line5_y  =  rvh_bar.line4_y  +  c_drop; 

rvh_bar.labcl_color  =  7; 
rvh_bar.value_color  =  14; 

/* - 

*1 

buffer. view.left  =  c_width  *  5;  //  Bottom  left  comer 

buffer. view.ri^t  =  buffer. view.left  +  c_width  *  6; 

buffer. view.top  =  ymax  *  0.865; 

buffer. view.bottom  =  buffer. view.top  +  c_height  *  2; 

buffer.view.clip  =  YES; 

if  (buffer. view.right  >=  xmax)  buffer. view.right  =  xmax  -  1; 

buffer.linel_y  =  c_hei^t; 

buffer. Iiiie2_y  *  buffer.liiiel_y  +  c_drop; 
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/♦ - - - — - 

*/ 

rndv.view.left  “  buffwr.view.rigjit  +  c_width  *  8;  //  Bottom  left 

indv.view.ri^t  ■  nidv.view.left  +  c_widtti  *  14; 
mdv.view.top  •  buffer,  view.top; 
mdv.view.bottom  »  mdv.view.top  +  c_height  ♦  3; 
radv.view.cUp  “  YES; 

nidv.Iiiiel_y  **  buffer.linel _y; 
mdv.line2_>'  «  buffer. Iine2_y; 

- - 

*/ 

xsize  *  xmex  *  0.25; 
ysize  =  ymex  '*  0.15; 

h_ber.view.left  =  xmex  -  1  -  xsiie;  //  Top  right  comer 

h_ber.view.right  «  xmex  -  1; 

h_ber.  view,  top  *  0; 

h_ber.view.bottom  »  ysize; 

h_ber.view.clip  =  YES; 

h  ber.hlme_xl  =  xsize  *  0.0625;  //  6.25%  of  box  width 

h~ber.hlinc”x2  =  h_ber.hline_xl  +  xsize  *  0.875; 
h_ber.hline_y  *  ysize  "■  0.40; 

h_ber.vline_x  =  xsize  *  0.50; 
h_ber.vlme_yl  =  ysize  *0.21; 
h  ber.vline_y2  =  h_ber.vline _yl  +  ysize  *  0.25; 

h_ber.n8_delte_x  ®  xsize  *0.03125; 

h_ber.hber_y  =  ysize  *  0. 10; 
h_ber.kft_yl  *  ysize  *  0.82  -  c_height; 
h~ber.kft_y2  =  h_ber.kft_yl  +  10; 
h_ber.kft_x  =  c_width; 
h_ber.cit)ss_x  «  c_width  *  16; 
h  ber.cross  xt  h  ber.cross_x  +  c_width  *  4; 


/*-— - — - - 

*/ 

exis.riiiie_y2  =  ymex  *  0.92;  //  R  »ws  is  92%  ymex 

exis.lsbel_vert.y  =  exis.rline _y2; 
exis.lebel_horz.x  «  c_width  *  2; 

//  exi8.1ebel_vert.x  «  xmid  +  c_width; 

//  exis.lebei_borz.y  »  ymid  -  c_height; 
exis.lebel  color  -  12; 

} 
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* - *! 

void  iip«_ivplot_uiit(Npa_|dot_iiifo  RV_vector  *prev,  Vectm*  *prev_rvdot, 
char  **iiieott,  int  type,  int  hbar_oo, 
udMMt  bufier_iiiax,  uahort  buffer  cot) 

( 

static  char  fmtlQ  «  fmt2a  «  •ftS.SfK"; 

iot  xmax  ops _fraphica_info.xiBax; 

int  xmid  «  nps_graphics_info.xiiiid; 
int  ymid  >■  npsjgraphics_info.ymid: 
int  c_width  »  np5_graphics_info.c_width; 
int  c_height  »  nps _graphics_info.c_height; 

Nps_pIot_axis  '^uus_horz  «  info- >  axis  -t-  info->axis_horz; 

Np8_piot_axi8  *axis_vert  s  info- >  axis  +  info->axis_vert; 

int  x_origin,  y_origin,  x_axis_show,  y_axis_show; 
int  xl,  x2,  x3,  yl,  y2,  y3,  cnt; 

char  ^fint,  woflc[32]; 

double  step,  point; 

int  x_range_is_ft,  y_range_is_ft; 

*/ 

if  (time.view.bottom  =  »  0)  points_initO; 
cleaideviceO; 

settextstyle(SMALL_FONT,  HORIZ_DIR,  nps_gn4>hics_uifo.font_8ize); 
plot_type  =  type; 

/* - 

*  Draw  the  Wander  box. 

*/ 

b_bar.i8_on  *  (type  NPS_rvpIot_rv  &&  hbar_on  ==  YES); 

if  (h  bar.is  <») 

{ 

nps_plot_clear_view(&h_bar.view,  YES); 

line(h_bar.hline_xl,  h_bar.hline_y,  h_bar.hline_x2,  b_bar.hline_y); 
line(h_bar.vline_x,  h_bar.vline_yl,  h_bar.vline_x,  h_bar.vUnc_y2); 

aettextju8tify{CENTER_TEXT,CENTER_TEXT); 

outtextxy(h_bar.hline_xl  +  h_bar.ns_delta_x,  h_bar.hlinc_y  +  c_beight,  *N*); 
outtextxy0i_bar.hline_x2  -  h_bar.ns_delta_x,  h_bar.hline_y  +  c_height,  "S"); 
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oiittextxy(h_b«r.vliiie_x,  h_lMr.hiMr _y,  •hb»r’): 

•ettextjuftiiy(LEFT_TEXT,CENTER_TEXT>; 
oiittext]^(b_bu’.cron_x,  h_b«r.kft_yl,  "cfonover"); 
outtextxy(h_iMr.croM_x,  h_b«r.kft_y2,  *  in'); 

viewQ; 

) 


/♦ - 

*  Draw  horixontal/veitical  axis. 

*  1  pretend  I’m  drawing  in  a  1x1  window,  but  the  y-axis  is  clipped  more 
thsw  the  x-axis,  dius  all  scaling  is  done  with  the  x-axis  size. 

*  The  X  origin  determines  the  location  of  the  Y  axis  and  visa-versa. 

*/ 

setcolor(7); 

8ettextjustily(CENTER_TEXT,CENTER_TEXT); 
x_axis_show  *  y_axis_show  =  YES; 

//GIGO 

x_ori^  (intKaxis_horz->  origin  *  (double)xmid  /  axis_borz- >  range)  +  xmid; 

if(x  origin  >—  nps _graphics  info.xmax) 

{ 

if  (x_origin  >  nps_grBphic8_info.xmax)  y_axis_show  =  NO; 

X  origin  <=  nps ^graphics  info.xmax  •  1; 

else  if  (x_origin  <  0)  {  x_origin  =  0;  y_axi8_show  =  NO;  } 

y_origin  *  (intX-axis_vert->  origin  ■"  (double)xmid  /  axis_vert->  range)  +  ymid; 
if  (y  origin  >  =  nps^graphics  info.ymax) 

{ 

if  (y_origin  >  nps jgraphics_info.ymax)  x_axis_sbow  =  NO; 
y  origin  s  nps_graphics_info.yniax  -  1; 

} 

else  if  (y_origin  <  0)  {  y_origin  =  0;  x_axis_show  »  NO;  } 

8etlinestyle((y_axis_show  ?  SOUD_UNE  :  DOTTED_UNE),  0,  NORM_WlDTH); 
line(x_origin,  0,  x_origin,  axis.iiine _y2); 

aetlinestyle((x_axi8_show  ?  S01JD_UNE  :  DOTTED_UNE),  0,  NORM_WIDra); 
llne(0,  y_ori^,  xmax-1,  y_ori^); 

setlioeatyle(SOLID_UNE.  0.  NORM.WIDTH); 

/* - 

*  Draw  horizontal  axis  ticks  . 

I* 

*  The  range  tells  me  how  much  to  show  on  one  axis  (from  center  to  edge). 
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*  and  is  divided  into  four  sccUcmis.  *Step'  is  the  value  of  one  section. 

*  The  range  is  always  in  kilo>feet  (as  are  the  date  points),  but  I  switch 

*  the  labels  to  feet  when  the  range  grows  too  small. 

*  The  loop  makes  tick-points  and  labels  travelling  out  from  the  center. 

*/ 

//GIGO 

aettextjustify(LEFT_TEXT,CENTER_TEXD; 

stq>  «  axis_horz->nmge  /  4.0; 
if  (step  <*  1.0) 

{ 

x_range_is_ft  *  YES; 

foit  K  (fobs(axis  horz->origin)  <s  axis_horz-> range  ?  fintl  :  fmt2); 
fint(5]  *  0; 

} 

else  {  x_range_is_ft  =  NO;  fmt  *  frntl;  fmt[S]  =  ’K’;  } 
yl  -  y_origin  -  5;  y2  *  y_origin  5; 

if  (y_origin  >  nps _graphics_info.ymax  -  20)  y3  »  yl  -  c_height; 

*ls*  y3  =  y2  +  c_height; 

setcolorfaxis.  label_color); 

outtextxy(axis.labei_horz.x,  y3,  plot_stuff[plot_type].iabel_horz); 
setcolor^); 

aettextjustify(CENTER_TEXT,CENTER_TEXT); 

for  (ent  =  0;  ent  <*3;  cnt++) 

{ 

x3  —  xmid/4  ent; 

if  ((xl  as  xmid  -  x3)  !=  x  origin) 

{ 

line(xl,  yl,  xl,  y2); 

point  =  stq)  ent  +  axis_horz->  origin; 
if  (x_range_is_ft)  point  ■"=  1000.0; 

8printf(work,  fint,  point);  outtextxy(xl,  y3,  work); 

} 

if  (ent  s  =  0)  continue; 

if  ((x2  =  xmid  +  x3)  !  =  x  origin) 

{ 

line(x2,  yl,  x2,  y2); 

point  s  step  *  -ent  +  axis_borz->  origin; 
if  (x_range_is_ft)  point  1000.0; 
sprintf(work,  fint,  point);  outtextxy(x2,  y3,  work); 

> 


/*■ 
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*  Dnw  vertical  axis  tidu. 

* 

*  The  rufe  on  diis  axis  is  divided  into  four  sections  per  side,  same  as 

*  the  horizontal  axis,  bid  only  three  of  diem  fit  on  the  screen. 

*  Don’t  fotget  diat  we’re  pretending  to  draw  in  a  1x1  window,  but  the 

*  actual  x-axis  is  larger,  so  we  must  scale  the  points  using  the  x-size. 

*1 

//GIGO 

settex^ustify(LEFT_TEXT,CENTER_TEXT); 

step  «  axis_vert->  range  /  4.0; 
if  (step  <  1.0) 

{ 

y_range_is_fl  »  YES; 

fmt  =  (fid>s(axis_vert-> origin)  <*  axi8_vert* > range  ?  ftntl  ;  iint2); 
fmt[5]  «  0; 

} 

else  (  y_nBige_is_ft  *  NO;  fint  *  ftntl;  ftnt[S]  *  ’K’;  } 
xl  »  x_origin  -  5;  x2  *  x_origin  +  5; 

if  (x_origin  >  nps _gia{diics_info.xinax  -  20)  x3  «  xl  -  c_widtb  *  6; 
else  x3  =  x2  +  c_width; 

aetcolor(axis.  label_color); 

outtextxy(x3,  axis.label_vert.y,  plot_8tuff[plot_typcl.label_vert); 
setcolor(7); 

for  (cnt  *=  0;  cnt  <  =  2;  cnt+  +) 

{ 

y3  =  xmid/4  *  cnt; 

if  ((yl  »  ymid  -  y3)  !=  y_origin) 

{ 

line(xl,  yl,  x2,  yl); 

point  =  step  -cnt  +  axis_vert->  origin; 
if  (y_range_is_ft)  point  "■=  1000.0; 
sprintf(woik,  ftnt,  point);  outtextxy(x3,  yl,  work); 

} 

if  (cnt  »  ss  0)  continue; 

if  ((y2  *  ymid  +  y3) !»  y  origin) 

{ 

line(xl,  y2,  x2,  y2); 

point  step  *  cnt  -t-  axi8_vert->  origin; 

if  (y_rangc_i8_ft)  point  *=  1000.0; 

qmntfiworic,  point);  outtextxy(x3,  y2,  work); 

} 

> 
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*  Draw  nun^  box,  time  labels,  and  oieau  bar. 

*1 

aettextju8tily(LEFT_TEXT,CENTER_TEXD; 

xl  «  rvh_bar.view.left  -  c_width  *  4; 

•etcolor(rvh_bar.label_color); 

oiittextxy(xl,  rvh_bar.view.top  +  rvh_bar.liiiel_y,  ’vbar*); 
outtextxy(xl,  rvh_bar.view.top  -t-  rvh_bar.line2_y,  ’rbar*); 
outtextxy(xl,  rvh_bar.view.top  +  rvh_bar.liiK3_y,  "hbar*); 
outtextxy(xl,  fvh_bar.view.top  +  rvh_bar.tiiie4_y.  "dist’); 
outtextxy(xl,  rvh_bar.view.top  +  rvh_bar.liiieS_y.  “rate"); 
aetcoloi<7); 

xl  «  buffer. view.left  -  c_width  *  S; 

outtextxy(xl,  buffer. view.top  +  bufrer.liiiel_y,  “bufr"); 

outtextxy(xl,  buffer,  view.top  +  buffer.iiiie2_y,  *  of); 

xl  »  buffer.view.left  +  c_width/2: 

sprintftwork,  *%4u*,  buffer_iiiax); 

outtextxy(xl,  buffer. view.top  -f  buffer. Iiiie2_y,  work); 

xl  s  time. view. left  •  c_width  *  8; 

outtextxy(xl,  time. view.top  -f  time.linel_y,  mfo->target_title); 
outtextxy(xl,  time. view.top  4-  tiiiie.iiiie2_y,  info->diaser_title); 

setcolor(time.desc_color): 
xl  +  “  c_width  *  4; 

outtexUy(xl,  time.view.top  +  time.line3_y,  plot_stuff[plot_type]. title); 
setcolor(7); 

if  (menu  ! «  NULL)  nps_nienuplot _ init(menu); 

/* - 

*  Draw  the  previous  known  time  and  data  values. 

•/ 

nps  rvplot _ valuesQ>rev->pos.x  ♦  KILOM  TO_KILOFT,  prev->pos.y  ♦  KILOM_TO  KILOFT, 

prev-  >  pos.z  *  iaLOM_TO_KILOFT,  prev  rvdot-  >  x  ■»  KILOM_TO_KILOFT, 
prev_rvdot->2  •  KILOM_Tb_KlLOFT,  buffer_cnt); 

nps  rvplot__time(ptev->time,  prev- >  time); 

) 


/*• 


* - */ 

void  nps  rvplot__time(double  tl,  double  t2) 

( 

int  e_width  »  nps _frBphies_info.c_width; 
char  work[20]; 

/* - 
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*1 

iiptjpk>t_clev  viewC&time.view,  NO); 

•ettexyuitify(liiT_TEXT.CENTER_TEXD; 

tl  86400.0; 
diiie_dbl_to_ttriiig(&tI,  woiic); 
oiittextxy(c_wtdth/2.  work); 

t2  -f  «  86400.0; 
tiiiie_dbl_to_striiig(&t2,  work); 
oiittextxy(c_width/2,  ttiiie.Uiie2_y,  work); 

a|M_j>lot_nuun  viewQ; 

} 


/♦=«*  =  =:! 


♦ - */ 

void  nps_rvplot_va)ues(double  x,  double  y,  double  z, 

double  d,  double  rdot,  ushort  bufrer_ciit) 

{ 

static  char  jfint_rvD  =  *%8.3f  Kft/s'; 
int  c_width  =  nps_gra|ducsjnfo.c_width; 
char  work[32]; 

/* - 

*1 

Bps_plot _ clear_view(&rvh_bar.view,  NO); 

8ettextjustily(LBFT_TEXT,CENTER_TEXT0; 

setcolor(rvh_bar.value_color); 

*1 

fint_rv[91  =  0; 

if  (fab8(x)  <  1.0)  {  fmt_rv[6)  =  x  ♦=  1000.0;  } 

else  {  ftnt_rv[6]  =  ’K’;  } 

sprintf(woik,  fot_rv,  x); 
outtextxy(c_width/2,  rvh_bar.linel_y,  work); 

if  (fid»(z)  <  10)  {  fmt_rv[61  »  z  *»  1000.0;  } 

else  {  fint_rv[6]  »  ’K’;  } 

qnintiitwork,  hatjv,  z); 
outtextxy(c_width/2,  rvh_bar.liii^_y,  work); 

if  (fid>s(y)  <  1.0)  {  fiiit_rv[6]  *  ’  y  •»*  1000.0;  } 

else  {  fiiit_rvI6]  *  ’K’;  } 

sprintf[work,  fat_rv,  y); 
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oiittextxy(c_widdi/2,  rvh_bu’.Iiiie3_>,  w<Mk); 

if  (fidM(d)  <  1.0)  {  fiat  rv[6]  «  ’  *;  d  *-  1000.0;  } 

0)fe  {  fmt_rvl6]  »  ’K’;  } 

tprintitwork,  d); 

outtextxy(c_width/2.  rvfa_bu’.liiie4_y,  wort;); 

/* - 

*/ 

fmt_iv{91  »  V’; 

if  (fiMrdot)  <  1.0)  {  ftirt_rv[61  »  rdot  *=  1000.0;  } 
else  {  fint_rv[61  *  ’K’;  } 

8printf(work,  fnit_rv,  rdot); 
outtextxy(c_widtli/2,  rv|i_ber.liiie5_y,  work); 

/* - 

*/ 

tetcolor(7); 

aps_piot _ ^eleer_view(dUMtfFer.view,  NO); 

qmiitf(work,  bufrer_cnt); 

outtextxy(c_width/2,  buffer.liiiel_y,  work); 

ops _plot_niain  viewO: 

} 


/*=  ssscasssaBsssssssKsssssssssssssKs 

* -  -  - -  —  */ 

void  ops  rvpiot _ hbar(doubIe  y,  double  ydot,  double  crossing_tiine) 

{ 

static  char  fnit_hQ  =  ''%8.3f  Kft/s'; 
static  char  ft[20],  fps[24],  tinie{20]; 
static  int  oid_y; 

int  c_height  »  ops _gn4>hics_info.c_height; 
int  mins,  secs; 

/* - 

*/ 

setviewport(h_bar.view.ief),  h_bar.view.top,  h_bar.view.right, 
h_bar.view.bottom,  h_bar.view.clip); 

settextjustily(CENTER_TEXT,CENTER_TEXD; 

s^color(0); 

outtextxy^_bar.vUne_x  +  old_y,  h_bar.hline_y  -  c_height,  "  1 "); 
aetcolor(7); 
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oId_y  ■  (intXy  *  100); 

oiittextxy(h_lMr.vlii)e_x  +  old_y,  h_bw.hline_y  -c_ljeight,  *1"); 

/* - 

*1 

ie«extiu«tily(LEFT_TEXT.CENTER_TEXD; 

wteoloi(0); 

outtextxy(h_bar.kft_x,  h_b*r.kft_yl,  ft); 
oiittextxy(b_)Mr.kft_x,  h_bw.kft_y2,  ^); 
outtextxy(h_l»r.cross_xt.  h_bu'.kft_y2,  time); 

tetcolor(7); 

fint  h[91  *  0; 

if  (fcbs(y)  <  1.0)  {  fint  h[6J  =  ’  *;  y  *=  1000.0;  } 

else  {  fint_h[61  =~K’;  } 

sprintftft,  fint_h,  y); 
outtextxy(h_lw.kft_x,  h_b*r.kft_yl,  ft); 


fmt_hI91  »  7’; 

if  (fid»(ydot)  <  1.0)  (  fint  h[6]  *  ’  ydot  ■*=  1000.0;  } 
else  {  fint_h[6]  =  ’K’;  } 

sprintftfps,  fint_h,  ydot); 
outtextxy(h_bar.kft_x,  h_b«r.kft_y2,  fps); 

/m - 

*/ 

mins  s  cro8sing_time  /  60.0; 
secs  =  crossing_time  •  (mins  '*  60); 
sprintf(time,  ''%7)2.2d;%02.2d'',  mins,  secs); 
outtextxy(h_bar.cross_xt,  h_bar.kft_y2,  time); 

nps_plot _ main_viewO; 

} 


* - ♦/ 

void  nps  rvplot  point(Nps  plot  info  *info.  Vector  ♦pos, 

double  tl,  double  t2,  ushort  buffer_cnt. 
Vector  *rvdot,  double  crossing  time) 

{ 

//GIGO 

int  xmid  «  nps_gr^iiucs_info.xinid; 
int  ymid  »  nps _graplucs_info.ymid; 

doid>le  X  »  pos->x  *  KILOM_TO_KILOFT; 
double  y  «  pos*>y  *  KILOM_TO_KILOFT; 
double  z  *  pos->z  *  KILOM_TO_KILOFT; 
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double  diet  «  rvdot->x  *  iaLOM_TO_KILOFT; 
double  ydot  »»  rvdot->y  *  KILOM_TO^KILOFT; 
double  rdot  »  rvdot->z  "■  KILOM_TO_iaLOFT; 
double  borz,  vert; 

Nps_plot_uis  *axi»_horz  *  info- >  axis  +  info->axis_horz; 

Npsj)iot_axis  ‘*axis_vert  =  info- >  axis  +  info->axis_vert; 

int  xpoint,  ypoint; 

*/ 

nps_rvplot _ ^vaiues(x,  y,  z,  dist,  idot,  buffer_cnt); 

nps  rvpiot _ tinie(tl,  t2); 

if  (h_bar.is_on)  nps_rvplot _ hbar(y,  ydot,  crossingjime); 

/* - 

*/ 

borz  =  (plot_type  =  *  NPS_rvplot_ih  ?  y  ;  x); 
vert  =  (plot_type  *  =  NPS_rvplot  bv  ?  y  :  z); 

xpoint  =  (intK-(horz-axis_horz->  origin)  *  (double)xmid  /  axis_horz- >  range)  +  xmid; 
ypoint  =  (int)((vert-axis_vert->  origin)  *  (double)xmid  /  axis_vert->  range)  +  ymid; 
if  (xpoint  >  s  0  &&.  xpoint  <  nps _gn^>hics_info.xmax 

&&  ypoint  >  =  0  Si&  ypoint  <  nps _graphics_info.yniax)  putpixe)(xpoint,  ypoint,  7); 


* - */ 

void  nps  rvpiot  point  fast(Nps  plot  info  "‘info.  Vector  "‘pos) 

{ 

int  xmid  =  nps_g^^>hics_info.xnlid; 
int  ymid  =  nps_graphics_info.ymid; 

double  X  =  pos->x  *'  KILOM_TO_KILOFT; 
double  y  =  pos->y  KILOM_TC_KILOFT; 
double  z  =  pos->z  *  KILOM_TO_KILX)FT; 
double  borz,  vert; 

Nps_plot_axis  '*axis_borz  =  info- >  axis  +  info->axis_borz; 
Nps_plot_axis  '*axis_vert  =  info- >  axis  +  info->axis_vcrt; 

int  xpoint,  ypoint; 

/* - 

*! 

srttextju8tify(CENTER_’rEXT,CENTER_TEXT); 
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aetoolor(7); 

horz  «  (plot_type  =  *  NPS_rvplot_rh  ?  y  :  x>; 
vert  »  (pIot_Qrpe  *  »  NPS_rvpIot_bv  ?  y  :  z); 

xpoint  s  (iiitK-(borz-axis_horz->  origin)  *  (double)xmid  /  nxis_horz->  range)  +  xmid; 
ypoint  =  (inO((vert-axis_vert*>  origin)  ♦  (double)xnud  /  axis_vert->  range)  +  ymid; 
if  (xpoint  >  =  0  ScA  xpoint  <  nps_gn4)hics_info.xniax 

&&  ypoint  >  —  0  ScA  ypoint  <  nps_gnphics_info.yniax)  putpixel(xpoint,  ypobt,  7); 


* - */ 

void  nps  rvpiot  point  textfNps  plot  info  ‘Hnfo,  Vector  "'pos,  char  'Hext,  int  bright) 

{ 

int  xmid  =  nps_graphics_info.xniid; 
int  ymid  as  nps _graphics_info.ymid: 

double  X  =  po'  *  iaLOM_TO_KILOFT; 
double  y  =  pos->v  'ILOM_TO  WLOFT; 
double  2  =  pot->  '  >  ”a)M_T02KIL0FT; 

•*  able  horz,  vert; 

Nps_plot_axis  *axis_horz  =  info- >  axis  +  info->axis_horz: 

Nps_plot_axis  ♦axis_vert  =  info- >  axis  +  info->axis_vert; 

int  xpoint,  ypoint; 

/* - 

*1 

8ettextstyle(SMALL_FONT,  HORIZ_DIR,  2); 
settextjustify(CENTER_TEXT,CENTER_TEXT); 
setcolor(bright  ?  rvh_bar.value_coior  :  7); 

horz  =  (plot_type  =  =  NPS_rvplot_rh  ?  y  :  x); 
vert  =  (plot_type  =  =  NPS_rvplot_hv  ?  y  :  z); 

xpoint  s:  (int)(-(horz-axis_horz->  origin)  *  (doubie)xmid  /  axis_horz->  range)  +  xmid; 
ypoint  *  (int)((vert-axis_vert->  origin)  *  (doubie)xmid  /  axis_vert->  range)  -f-  ymid; 
if  (xpoint  >  as  0  ScA  xpoint  <  nps _gnq)hics_info.xmax 
ScA  ypoint  >  aa:  0  SiA  ypoint  <  nps _graphics_info.ymax) 

{ 

outtextxy(xpoint,  ypoint,  text); 

} 

s^xtstyle(SMALL_FONT,  HORIZ_DIR,  nps_^raphics_info.font_size); 
setcolor(7); 


/♦a 
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-*/ 


void  nps  ivptot_nidv(Np«_plot  info  "info,  Vector  *nidv_dv,  double  mdv  dist) 
fltatic  char  foit_dvQ  s  *%7.3f  Kft/s*; 


int  c_width  «  nps _graphics_info.c_width; 

double  dv; 
char  woik[32]; 


/* - 

*/ 

outtextxy(mdv. view. left  -  c_width  "■  3,  mdv.view.top  +  nidv.linel_y,  "RNDV"); 
npsjplot _ ^clear_view(&mdv.view,  NO); 

8ettextjustify(LHT_TEXT,CENTCR_TEXD; 

setcolor(7); 


mdv_dist  ♦=  iaLOM_TO_iaLOFT;  fint_dvt91  =  0; 

if  (ftd>s(mdv  dist)  <  1.0)  {  ftnt  dv[6]  =  ’  mdv_dist  1000.0;  } 

else  ~  {  ftnt_dv[6]  ="’K’;  } 

sprintftwork,  ftnt_dv,  indv_dist); 

outtextxy(c_width/2,  mdv.linel_y,  woric); 

dv  =  vector  inagnitudo(mdv  dv)  ♦  HLOM  TO  KILOFT;  foit  dvf9]  =  V’; 

if  (fobs(dv)  <  1.0)  {  ftnt  dv[6]  =  ”;  dv  *=  1000.0;  } 

else  {  ftnt_dv(6]  = ’K’;  } 

sprintftwork,  ftnt_dv,  dv); 

outtextxy(c_width/2,  indv.line2__y,  work); 

nps_plot_niiun_view0; 

} 
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/*=: 


-*/ 


jKnclude  <stdio.h> 
#incliide  <mem.h> 

^include  <edit.h> 
#include  <coin_poit.h> 
iKnclude  <packet.h> 
delude  'nm-h* 


static  int  port_id,  said_orb_gps: 


* - */ 

int  gen_initO 

{ 

ushort  tx_size  s:  S12; 
char  ^answer; 

I* - 

*! 

port_id  =  edit_integer(''Eiiter  output  port  id  *,  1); 

/*  tx_si2e  =  edit_integer(*  ^ter  tx  size  ",  512);  *! 

if  (com_port_start(port_id,  0,  tx_size)  =  =  NO) 

{ 

printfCCan’t  start  port  %d\n",  port_id); 
port_id  =  0; 
return  NO; 

} 


/* - 

*! 

answer  =  edit_text("Send  Orbiter-GPS  packets  too  ?  ",  "y"); 
said_orb _gps  =  (answer[0]  ==  ’y’  1 1  answeifO]  =s=  ’Y’); 

return  YES; 

} 


* - */ 

void  gen_8top0 

{ 

if  (portjd)  coinj>oft_stop(port_id); 
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} 


• - - •/ 

■Utic  void  state  vector  scaIe(State  vector  *ui,  State_vector  *out,  double  scale,  double  dtime) 

{ 

out->pos.x  «  in*>pos.x  *  scale; 
out*>pos.y  =  in->pos.y  *  scale; 
out->pos.z  SB  tn->pos.z  *  scale; 
out->vel.x  =  in->vel.x  *  scale; 
out->vel.y  =  ln->vel.y  *  scale; 
out->vel.z  *  in->vel.z  ♦  scale; 
out- >  time  =:  in- >  time  +  dtime; 

} 


The  packet  has  start  sync  eb  90,  stop  ^nc  BE  EF,  and  types  1  and  2. 

* - */ 

void  gen  save  sample(Sim  sample  ’*'sa^:^>le) 

struct 

{ 

Orb_packet  orb; 

Spas_packet  spas; 

Orb _gps_packet  gps; 

}  packet; 

ubyte  'Svhere  —  (ubyte  '*')&packet; 
ushort  bytes  »  sizeof(packet); 

/* - 

*1 

memset(&packet,  0,  sizeof(packet)); 

packet.orb.header.type  =  PKT_orbiter; 
packet.ofb.header.8ync_8tait[0]  —  Oxeb; 
packet.ofb.header.8ync_start[l]  »  0x90; 
packet.orb.tniler.^c_stop[0]  Oxbe; 
packet.orb.trailer.^c_atc^[l]  »  Oxef; 

state_vector_8cale(&sample->oib_ins,  d)^)acket.orb.orbiter_vector,  KILOM_TO_FT,  86400.0); 
state_vector_8cale(&sanq>le->ofb_targ,  &packet.OTb.target_vector,  KILOM_TO_FT,  86400.0); 
packet.oib.orbiter_quat  sb  saiiq>Ie->orb_quat; 
packet.orb.ofbiter_quat.time  4-s  86400.0; 

/* - 

*/ 

packet.q>as.header.type  b:  PKT_spas; 
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packet.s|ms.beader.^nc_surt[0]  »  Oxeb; 
packet.spas.heMler.sync_stut[l]  »  0x90; 
packet.spas.tniler.sync_stop[0]  =  Oxbe; 
packet.qMu.tru]er.sync_stop[l]  =  Oxef; 

sUte_vector_scale(&suiiple->s|Ms_sv,  &packet.spas.8p«s_vector,  KILOM_TO_FT,  86400.0); 
state_vector_8cale(&sample->q»s_gps,  &packet.^)as.gps_vector,  KILOM_TO_FT,  86400.0); 

/•» - 

•/ 

if  (seDd_orb ,^gps) 

{ 

packet.gps.header.type  =  PKT _jgps; 
packet.gps.header.sync_stait[0]  —  Oxeb; 
packet.gps.header.syoc_start[l]  =  0x90; 
packet.^.trailer.sync_stop[0]  =  Oxbe; 
packet.gps.traiIer.sync_stop[l]  s  Oxef; 

state  vector_scale(&saiiiple->orb_jps_ecef,  &packet.gps.gps_vector,  1000.0,  86400.0); 

} 

else  bytes  •=  sizeof(Orb_gps_packet); 

/* - 

*1 

while  (bytes  >  0) 

{ 

if  (coin_port_put(poft_id,  "where)  ==  =  NO)  continue; 
bytes~;  where+  + ; 

/*  if  (kbhitO)  break;  */ 

} 
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/*« 


*  -  -  -  -  */ 

jKnclude  <stdio.h> 
iKnclude  <iiieiii.h> 

#iiiclude  <io.h> 
jKnclude  <fcntl.h> 

iKnclude  <edit.h> 

#include  <packet.h> 
include  "sim.b'' 


* - *! 

sutic  int  port_file,  port_status,  send_orb _gps; 

#define  HLE_1S_DEV1CE  0x0080 
#defiiie  nLE_IS_RAW  0x0020 
#define  HLE  SET  BITS  OxOOff 


♦ - ♦/ 

int  gen  initO 

{ 

char  *fileiuuiie,  ^answer; 

/♦ - 

*/ 

filename  =  ediMextCEnter  output  port/file:*,  "coml”); 

if  ((port_file  =  openffUesuune,  O  RDWR 1 0_BINARY  1 0_CREAT,  0666))  <  0) 

{ 

printfCCan’t  open  poit/fUe  %s\n'',  filename); 
return  NO; 

} 


/* - 

If  output  file  is  a  device,  place  that  device  in  "raw*  mode. 

*1 

port_status  =  ioctl(port_file,  0,  0,0); 

if  (poit_status  &  FILE  IS_DEVICE) 

{ 

poTt_status  —  (port_status  &  FILE_SET_BITS)  |  FIL£_IS_RAW; 
ioctI(port_file,  1,  port_8tatus,0); 

} 


/*■ 
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*/ 

answer  »  edit_text(*Seod  Orbiter-GPS  pndcets  too  ?  *,  *y*); 
•eiMi_orb  gpg  «  (answ«(0]  « »  ’y’  1 1  answerfO]  * »  ’Y’); 

return  YES; 

} 


/•*» 


* - */ 

void  gen  stopO 

{ 

/* - 

*  If  output  file  is  a  device,  place  that  device  back  in  "cooked*  mode. 
*/ 

if  (port_status  &  F1LE_IS  DEVICE) 

{ 

port_status  -FILE_IS_RAW; 
ioctI(port  file,  1,  port  8tatus,0); 

} 

close(port  file); 

} 


- */ 

static  void  state  vector  scale(State  vector  *in.  State  vector  '*t>ut,  double  scale,  double  dtime) 

I 

out->pos.x  B  in->po8.x  scale; 
out->pos.y  =  in->pos.y  '''scale; 
out->pos.z  B  in->po8.z  *  scale; 
out*>vel.x  =  in*>vel.x  *  scale; 
out->vel.y  =  in->vel.y  "'scale; 
out->vel.z  B  in->vel,z  scale; 
out*>tiine  b  in->tiine  +  dtime; 

} 


/*B  = 


"'  The  pack^  has  start  ttyac  tb  90,  stop  qmc  BE  EF,  and  types  1  and  2. 

* - mi 

void  gen  save  sample(Sim  sample  "Sample) 

{  ■  " 
struct 

{ 

Orb_packet  orb; 

Spasjpacket  spas; 

Orb  gps  packet  gps; 

}  packet; 
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ubyte  *wlieie  *  (ul^  *)&p«cket; 
lufaort  bytes  m  sueofi({«eket); 
int  seat; 

/* - 

*1 

niemset(&|Mcket,  0,  sueofi(p*cket)); 

pecket.orb.header.type  *  nCT_orbiter; 
pscket.orb.hesder.sync_start[0]  »  Oxeb; 
pscket.ofb.besder.iyiic_8tsrt[l]  »  0x90; 
pscket.orb.trsiJer.qnic_stop[0]  »  Oxbe; 
pscket.orb.  trailer.  syoc_stop[l]  «  Oxef; 

state_vector_scaJe(&sainp)e->orfo_iiis,  &pecket.orb.orbiter_vector,  KILOM_TO_FT,  86400.0); 
state_v6Ctor_scale(&sainple- >  orb  targ,  &packet.orb.target_vector,  KILOM_TO_FT,  86400.0); 
packet.ofb.orbiter_quat  =  sample- >orb_quat; 
packet.orb.orbiter_quat.time  +=  86400.0; 

/* - 

•/ 

packet.8pas.header.type  =  PKT_spas; 
packet.q)as.header.sync_staft[0]  »  Oxeb; 
packet.spa8.header.syiic_start(l]  «  0x90; 
pad(et.qM8.trailer.syiic_stop(0]  »  Oxbe; 
packet.spas.trailer.8yiic_8top[l]  =  Oxef; 

state_vector_scale(&sample->spas_sv,  dqMcket.i^>as.spas_vector,  KILOM_TO_FT,  86400.0); 
state_vector_scale(&aample->q)a8_gps,  &packet.spas.gps_v6ctor,  KILOM_TO_FT,  86400.0); 

/* - 

*/ 

if  (said  orb_gps) 

{ 

packet.gps.header.Qrpe  PKT_gps; 
packet.gps.header.syiic_staft[0]  »  Oxeb; 
packet.gps.header.syiic_start(l]  «  0x90; 
packet.gps.trailer.syiic_stop(0]  «  Oxbe; 
packet.gps.traiIer.syiic_stop(l]  »  Oxef; 

state  vector  8cale(&sample->orb .^n»_ecef,  &packet.gp8.gps  vector,  1000.0,  86400.0); 
else  bytes  sizeoftOib _jps_packet); 

/* - 

*! 

while  (bytes  >  0) 

{ 

seat  _write(port_file,  where,  bytes); 
if  (seat  <  0)  break; 
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if  (aeot  >  0)  {  bytes  -»  seat;  where  +  »  sent;  } 
/*if(kblut0)  break;  */ 

} 

} 
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/♦» 


* - */ 

iKnclude  <stdio.b> 

#iiiclude  <edit.h> 
iNncliide  ‘siin.h* 


* - */ 

int  gen  initQ 

{ 

char  ‘"filename; 

■"/ 

filename  =  edit_text(*Enter  output  filename:”,  *sim.dat*); 

if((outfile  =  fopen(filenatne,  *wb”))  «=  NULL) 

( 

printf(”Can’t  open  %s\n”,  filename); 
return  NO; 

} 

return  YES; 

} 

void  gen  stopO 

{ 

fclose(outfile); 

} 

• - ■*/ 

void  gen  Mve_8anqile(Sim  sample  ^sample) 

{ 

fiivrite(sampie,  sizeof(Sim  sample),!,  outfile); 

} 
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* - •/ 

int  geo_initO  {  letun  YES;  } 

void  {  } 

void  gen_save_saiiiple(Siin_sunple  *mnple)  {  } 


gnona.c 


* - */ 

#iiiclude  <ttdlib.h> 

#iiicliide  <stdio.h> 
iKiicliide  <coiuo.h> 
finclude  <bios.h> 

^include  <tiiiie.h> 

finclude  ”siin.b” 

#include  <k^8.h> 

^include  <nps_if.h> 


extern  unsigned  _stklen  »  15000U;  //larger  stack 


♦ - */ 

static  int 

main_key_handler(int  key); 


static  void 

key_pfocess(void), 

inain_display_init(void), 

main_display_status(void); 


* - ♦/ 

static  int  ('*tny_k^_handler)(int)  ss  inain_key_handler; 


static  int  terminate  »  NO; 


/*» 


* - - */ 

void  niain(int  argc,  char  ""'tegv) 

{ 

/* - 

♦/ 

cIrscrO; 

if  (sim_iiiit(argc,  argv)  =  =  NO) 

{ 

puts(*8im_init0  Ailed  during  init*); 
r^uin; 

} 

if  (nps_!^stem_initO  *  “  NO) 

{ 

puts(''nps_^stem_initO  failed  during  init”); 
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return; 

} 

if  (nps_diaplay_iiiitO  *  “  YES) 

my_key_haiidler  »  Dps_k^_haiidler, 
elae  iiiain_display_initO; 

/* - 

*1 

for  (;;) 

{ 

static  Siin_sainple  sample; 
int  re; 

/* - 

Check  for  key  hit,  process  the  key,  see  if  somebody  wants  to  stop 
the  program. 

*! 

if  (keyhitO) 

{ 

key_processO: 
if  (terminate)  break; 

} 


/* - 

*  Get  next  sample,  call  all  data  update  routines.  The  _next_sampie 

*  routine  must  return  one  of  these  values: 

*  -1  Still  trying  to  get  a  sample,  call  me  again 

*  0  Done,  no  more  sauries  available  (usually  from  disk_sim) 

1  Ok,  got  the  sample 

*1 

if  ((rc  =  sim_next_sample(&sample))  <  1)  continue; 

nps_data_update(&sample.orb_ins,  &sample.orb_quat,  &sample.orb_targ, 
&sampie.orb_gps_m!K),  &sanq)ie.orb_gps_ecef, 

&sample.q>as  sv,  &sample.spas _gps); 

} 

nps_^stem_st<q)0; 

sim_stopO; 


♦ _ ♦/ 

static  void  k^_processO 

{ 

int  rc,  key  «  key _getO; 
rc  *  (•my_key_handl«')(key); 
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if  (re  »  ■  2) 

( 

my_key_lttndier  »  imun_key_haiKUer; 
maia  display  initO; 

) 

if  (re  S3  0)  siin_key  handlerfkey); 

} 


Returns: 

0  Didn’t  use  the  key 

*  1  Used  the  key 

*  2  Used  the  key.  My  subsystem  is  done 

*  - */ 

static  int  main_key_handler(int  key) 

{ 

if  (key  ==  ’y’  j  j  key  ==  ’Y’)  terminate  =  YES; 

else  if  (nps_display_initO  =  =  YES)  my_key_handler  =  nps_key_handler; 

return  YK; 


* _ ♦/ 

typedef  struct  {  mt  col,  row;  char  "iext;  }  Label; 

static  void  main  display  initO 

{ 

clrscrO; 
gotoxydO,  6); 

cputsCExit  program  (y/n)  ?  *); 
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* - */ 

#include  <8tddef.h> 

#include  <packet.h> 

#iiiclude  <pkt_if.h> 

#include  "sim.h'' 

^include  ''../nps/nps_iiiSO.h'' 


These  structures  are  owned  by  the  orb_port_processO  routine,  and  are  in 
'*  the  original  units:  orbiter  vectors  are  MSO  in  ft  and  ft/s,  spas  vectors  are 

*  WGS84  in  ft  and  ft/s. 

The  orbiter  time  is  absolute,  001/00:00:01.000  ==  1.0  sec  -f  86400  secs  (one 
day).  The  spas  time  is  also  absolute. 

*  _ *  / 

extern  OTb_packet  orbiter_packet; 

extern  Spas_packet  spas_packet; 


This  structure  is  also  owned  by  the  orb_port_process0  routine,  and  is  only 
used  for  testing.  The  vector  is  WGS84  in  m  and  m/s.  Its  time  is  absolute. 

_ ♦/ 

extern  Orb_gps_packet  orbiter_gps_packet; 


>*■ _ _ _ _ _ _ Htf 

int  sim_init(int  argc,  char  ''"*^gv) 

{ 

return  (argc  >  1  &&  u'gv[l]  !«=  NULL 
?  orb_port_init_byiuune(argv[l]) 

:  orb_port_init0); 

} 


♦ _ */ 

void  sim_stop0  {  orbj>ort_stop0;  } 

* - */ 

static  void  state_vector  scale(State_vector  *40,  State  vector  "'out,  double  scale,  double  dtime) 

{ 

out->pos.x  =  in->pos.x  "■  scale; 
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out->pos.y  s  iii->pos.y  '''scale; 
out->pos.z  »  in*>pos.z  *  scale; 
out->vel.x  ss  iii->vel.x  "'scale; 
out->veI.y  «  iii->vel.y  scale; 
out->vel.z  »=  in->vel.z  "■  scale; 
out->time  »  io->tune  +  dtime; 

} 


I  tfy  to  fill  in  my  packet  buffer,  piece  piece  if  necessaiy.  I  may  not 
get  all  the  bytes  I  need  in  one  read,  so  I  must  wait  for  them  to  arrive. 

* 

But  I  should  not  hold  up  other  processing  just  because  I  can’t  get  enough 
’*  bytes  from  my  port.  So  I  tell  my  caller  t^t  I’m  not  done  yet,  and  that  I 
must  be  called  again. 

1  return  one  of  these  values: 

"*  -1  Still  trying  to  get  a  sample,  call  me  agiun 

"'  1  Ok,  got  the  sample 

* _ */ 

int  sim  next  sample(Sim  sample  "'sample) 

int  type; 

if  ((Ore  =  orbjJortjprocessO)  ==  NO)  return  -1; 

if  (type  ==  PKT  orbiter) 

{ 

state_vector_scale(&orbiter_packet.oTbiter_vector,  &sample->orb_ins,  FT_TO_KILOM,  -86400.0); 
state_vector_scale(&orbiter_packet.target_vector,  &sample->orb_targ,  FT_TO_KILOM,  -86400.0); 
sanq)le->orb_quat  ^  orbiter_packet.orbiter_quat; 
sanq>le->orb_quat.time  -=  86400.0; 

} 

#  ifdcfNPS_GPS 

else  if  (type  =  =  PKT_spas) 

{ 

state_vector_scale(&spas_packet.spas_vector,  &sample->spas_sv,  FT_TO_KILOM,  -864(X).0); 
state_vector_scale(&spas_packet.gps  vector,  &sanipie->spas _gps,  FT  TO  KILOM,  -86400.0); 

} 

else  f*  type  =  =  PKT_gps  "■/ 

{ 

8tate_vector_scale(&oibiter _gpsjMcket.gps_vector,  &sample->orb_gps_ecef,  0.001,  -86400.0); 
state_vector_8cale(&orbiter _gps_packet.gps_vector,  &sanq>le->otb_gp8_mS0,  0.(X)1,  -864(X).0); 
nps  wgs84_to  mS(K&sanq>le->orb_gps_mS0,  NPS_MS0  conqmted,  YES); 

0  «>difNPS_GPS 
return  YES; 
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int  sim_kq<_hjuidler(int  key)  {  return  YES;  } 

int  siin_edit_display_initO  {  return  NO;  } 

int  sim_edit_key_handler(int  key)  {  return  YES;  } 
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* - *! 

#LDCIude  <ttdlib.h> 

fioclude  <edit_rt.h> 

#include  <times.h> 

#iiiciude  <keys.b> 

#incliide  <packet.b> 

#include  <pkt_if.b> 

#iiiclude  'sim.h* 

#uiclude  ''../nps/nps_iiiSO.b'' 

These  structures  are  owned  by  the  orb_port_processO  routine,  and  are  in 
*'  the  original  units:  orbiter  vectors  are  MSO  in  ft  and  ft/s,  spas  vectors  are 
WGS84  in  ft  and  ft/s. 

The  orbiter  time  is  absolute,  001/00:00:01.000  =—  1.0  sec  +  86400  secs  (one 
"*  day).  The  spas  time  is  also  absolute. 

* _ */ 

extern  Orb_packet  orbiter jpacket; 
extern  Spas_packet  spas_packet; 


*  This  structure  is  also  owned  by  the  orbjx>rt_process0  routine,  and  is  only 
used  for  testing.  The  vector  is  WGS84  in  m  and  m/s.  Its  time  is  absolute. 

*  Note:  this  structure  is  also  filled  in  by  the  tans_port_process0  routine. 

*  - */ 

extern  Orb _gps_packet  orbiter_gpsj;>acket; 


* -  --  -  — -  */ 

static  int  siffi_delay_flag  =  1,  8im_delay_ms  -  10(W,  sim_delay_save  =  KKW; 

typedef  struct  {  int  got,  smd;  double  time;  }  Packet_info; 
static  Packet_iiifo  orb,  gps; 


/*= 


* _ _*/ 

int  aim  init(int  argc,  char  ""'tegv) 

{ 

/* - - - 

*/ 
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af*v++;  argc-; 

if  (argc  >  0) 

{ 

if  (orbjx>rt_iiut_byiiaiiie(*arg;v+  +)  =  =  NO)  return  NO; 
argc-; 

} 

else  if  (orbj)ort_initO  ®=  =  NO)  return  NO; 

/* - 

*/ 

#  ifdefNPS_GPS 
if  (irgc  >  0) 

{ 

if  (tans_port_init_bynaine(*argv++)  ==  NO)  return  NO; 
argc-; 

} 

else  if  (tans_port_initO  =  =  NO)  return  NO; 

#  endifNPS  GPS 

/* - 

*1 

if  (argc  >  0)  siin_deiay_ins  =  siin_delay_save  =  atoi('*tegv); 
return  YES; 

} 


void  sim  stopQ 

{ 

orb_port_stopO; 

#  ifdefNPSGPS 
tansjport_stopO; 

#  endif  NFS  GPS 

} 


♦ - */ 

static  void  state  vector_scale(State_vector  "in,  State  vector  "tout,  double  scale,  double  dtime) 

{ 

out->pos.x  =  in->po8.x  "*  scale; 
out->pos.y  =  in->pos.y  *  scale; 
out->pos.z  =  in->pos.z  *  scale; 
out->vel.x  =  in->vel.x  "■  scale; 
out->vel.y  =  in->vel.y  *  scale; 
out->vel.z  =  in->vel.z  "■  scale; 
out- >  time  =  in- >  time  +  dtime; 
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} 


♦ - */ 

sUtic  void  aim  copy  jMcket(iiit  type,  Sim  aauqile  ^san^le) 

{ 

/• - 

*/ 

if  (type  =  »  PKT  oibiter) 

{ 

state_vector_scale(&orbiter_packet.orbiter_vector,  &aample->orb_ins,  FT_TO_KILOM.  -86400.0); 
sUte_vector_8ce]e(&orbiterjMcket.target_vector,  &sample->ori>_torg,  FT_TO_KILOM,  -86400.0); 
sample- >  orb_quat  »  orbiter_packet.orbiter_quat; 
sample- >orb_quat.  time  86400.0; 

} 

»  ifdefNPS_GPS 

else  if  (type  =  »  PKT  qias) 

{ 

state_vector_scale(&spas_packet.spas_vector,  &safflpie->spas_sv,  FT_TO_KILOM,  -864(X).0); 
state  vector  scaie(&4>asjMcket.gps  vector,  &sample->spas_gps,  FT  TO  KILOM,  -86400.0); 

}  '  ■ 

else  if  (type  =  =  PKT_fl)s) 

{ 

state_vector_scaie(&orbiter _s)sj>ackct.a>s_vector,  &saitq>ie->orb _H»_ecef,  0.001,  -86400.0); 
state_vector_sca]e(&orbiter ^gps_packet.gps_vector,  &sample->oii> _gps_in50,  0.(X)1,  -86400.0); 
nps  wgs84  to  aiS0(&sampie->orb jn>s  mSO,  NPS  MSO  conq;>uted,  YES); 

}  ■  ■  ■ 

#  eodif  NPS  GPS 

} 


1  return  one  of  these  values: 

-1  Still  tiying  to  get  a  sample,  call  me  again 
1  Ok,  got  the  sample 

* - */ 

int  sim  next  sample(Sim_sainple  "'sample) 

{ 

I* - 

*! 

if  (sim  delay  ms) 

{ 

if  (sim_delay_flag  0)  return  -1; 
sim_delay_flag  =  0; 

rtc_timer  setfsim  delay  ms,  &sim  delay  flag); 

} 


/"•- 

"■/ 
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if  (orb.got  •  •  NO) 

{ 

orb.got  »  orbjfmitjMocessO; 

#  ifdef  NPS_GPS 

if  (orb.got  *s  «  PKT_orbiter) 

orb.time  *  orbiter_packet.orbiter_vector.tiine; 

else  if  (orb.got  s  s  PICT_spas) 

OTb.time  «  spasjiMcket.gps  vector.time; 

#  endif  NPS  GPS 

} 

#  ifdef  NPS_GPS 

if  (gps.got  =  =  NO) 

{ 

ais.got  =  tans_port_processO; 

if  (Spsgot  =  =  PKT _gps) 

gps.time  =  orbiter  gps  packet.gps  vector.time; 

} 

#  endif  NPS_GPS 

/* - 

♦/ 

oib.send  =  gps.send  ^  NO; 

#  ifdef  NPS_GPS 

if  (orb.got  &&  gps.got) 

{ 

if  (orb.time  <  gps.time)  oib.send  =  YES; 
else  gps.send  =  YES; 

} 

else 

{ 

if  (gps.got)  gps.send  =  YES; 

if  (r^.got)  orb.  send  YES; 

} 

#  else 

if  (orb.got)  orb.send  =  YES; 

#  endif  NPS_GPS 

/* - 

*/ 

if  (orb.send  sa  NO  &&  gps.send  »»  NO)  return  -1; 

if  (orb.send) 

{ 

sim_copy_packet(orb.got,  saiqple); 
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orb.got  *  NO; 

} 

#  if<lefNPS_GPS 
if  (gpt.aead) 

{ 

sun_oo|>yjMcket(sps.got,  nmple); 
gps.gOt  ^  NO; 

} 

#  eodifNPS_GPS 
return  YES; 

} 


*  Returns: 

*  0  IMdn’t  use  the  key 

*  1  Used  the  key 

*  2  Used  the  key.  My  sub^stem  is  done 

*  - */ 

int  sim  key  handier(uit  key) 

{ 

if  (key  =  =  KEY_iIt_w)  sim_deUy_ins  =  0; 

else  if  (kry  =  *=  KEY_slt_t)  siin_delsy_ms  =  sim_delsy_nve; 

return  YES; 

} 


♦-123456789  123456789  123456789  123456789  123456789  123456789 

*  1  SIM  Settings 

♦2 

*  3  Realtime  delay  (ms):  X 
*4 

*  5  ALT-W  Warp  mode  (ignore  delay) 

*  6  ALT-T  Timed  mode  (use  delay) 

*  _ */ 

static  int  tenq>_delay_nis; 

static  void  screenl_j>re(Edit  screen  '^screen) 

{ 

temp  deiay_nis  as  sim  delay  save; 

static  void  screen  l_post(Edit  screen  "'screen) 

{ 

if  (sim_delay_ms  »  »  8im_delay_save)  sim_delay_ms  =  temp_&lay 
sim  delay_save  —  tenqi  delay  ms; 

}  - 
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static  Edit_label  labels!  Q  » 

{ 

{  1,20,  *SIM  Settiogs*}, 

{  3.  4,  'Realtime  delay  (ms):'}, 

{  S,  4,  'ALT-W  Warp  mode  (ignore  delay)'}, 

{  6,  4,  'ALT-T  Hmed  mode  (use  delay)'} 

}; 

fdefine  LABELl_COUNT  (sizBof(label8l)/sizeof(Edit_!abe!)) 

static  Edit  field  fields!  □  = 

{  ■ 

{  3,25,  edit  fieid_get  int,  edit_field_put_int,  edit  field  key  int,  &teixip_delay  ms 

};  ■  ■ 

fdefine  FIELD  l_COUNT  (sizeof(fieldsl)/si2eof(Edit_fie!d)) 

Edit_screen  screen  1  = 

{ 

LABELl_COUNT,  labelsl. 

FIELDl_COUNT,  fieldsl, 

NULL,  NO,  screenl_pre,  screenl_post 

}; 


static  Edit  screen  "^leensQ  = 

{ 

&screenl 

}; 

#define  MAX_SCREENS  (sizeof(screens)/sizeof(Edit_screai  "')) 
static  ut  current_scieen; 


int  sim_edit  display  initQ 

{ 

edit_scieeo_init(screens[current_screen]); 
return  YES; 

} 


I*--- 


* - *! 

int  sim  edit  key  handler(int  key) 

{ 

int  rc  B  edit_screai_k^_handler(8creens[curtent_screen],  key); 
if  (rc  >  0)  return  rc; 
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*! 

switch  (key) 

{ 

case  KEYj>giq;>: 

if  (— ciirreot_acieeo  <  0)  cuneat_acteeii  »  MAX_SCR£ENS  •  1; 
break; 

case  KEY_pgdn: 

if  (+  +cuiTeot_scieeii  >  »  MAX_SCREENS)  cuiTait_screeo  =  0 
break; 

default:  return  NO; 


edit_screen_init(screens{current_screen]); 
return  YES; 
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iKnclude  <ttdio.h> 
iKIacliide  <io.h> 
jKnclude  <fcnU.h> 
#include  <coiiio.h> 
#include  <oiem.b> 

^include  <edit.h> 
^include  <packet.h> 
^include  "sim.h* 


* - *! 

static  int  port_file,  port_status; 

^define  FILE  IS_DEVICE  0x0080 

#define  FILE~NOT_EOF  0x0040 

#define  HLE js_RAW  0x0020 
#defuie  HLE  SET  BITS  OxOOff 


static  int  check_sync(ubyte  *bufFer,  int  bytes,  ubyte  *sync); 


♦ - *! 

int  sim  initQ 

{ 

cbar  ''filename; 

*1 

filename  =  ediMextCEnter  input  port/file: ",  "coml"); 

if  ((port_file  *  open(filename,  O  RDONLY 1 0_BINARY))  <  0) 

{ 

printf(”Can’t  open  port/file  %s\n",  filename); 
return  NO; 

} 

/* - 

If  input  file  is  a  device,  place  that  device  in  "raw"  mode. 

*/ 

port_status  =  ioctl(port_file,  0,  0,0); 

if  (port_8tatus  &  FILE  IS  DEVICE) 

{ 

port_statu8  as  (port_status  &  FIL£_SET_BITS)  |  FILE_IS_RAW  |  FILE_NOT_EOF; 
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iocU(port  file,  I,  port  rtatuSiO); 

} 

return  YES; 

} 


e - */ 

void  si]B_stopO 

{ 

/* - 

If  input  file  is  a  device,  place  that  device  back  in  "cooked"  nxxle. 

*/ 

if  (port  status  &  FILE_IS_DEVICE) 

{ 

port_status  -FILE_IS_RAW; 
ioctI(port  file,  1,  port_status,0); 

} 


close(port_file); 

} 


*  DOS  sucks.  DOS  has  a  bug  regarding  devices  in  raw  mode,  this  piece  of  code 
fixes  the  error  caused  by  the  bug.  The  bug  occurs  under  these  conditions: 

*  •  You  are  reading  from  a  device  in  raw  mode. 

*  •  The  memory  you  are  reading  into  just  happens  to  fall  on  a  paragra]rii 
boundary  (i.e.  the  address  is  divisible  by  16). 

-  The  device  driver  doesn’t  have  any  bytes  ready  for  you. 

* 

Under  these  conditions,  DOS  will  erroneously  mark  your  file  with  an  EOF 

*  flag,  after  which  readQ  will  idways  fail,  even  if  the  device  has  some  bytes 

*  ready.  This  kludge  marks  the  file  as  not-EOF. 

*  _ */ 

static  void  fix_dos  eof  bug(void  ^location) 

{ 

if  (((ushort)location  &  15)  » =  0  ScA  port  sbUus  &  FILE  IS_DEV]CE) 

{ 

port_status  I «  FILE_NOT_EOF; 
ioctl(port_file,  1,  port_status,0); 

} 

} 


/** 


I  try  to  fill  in  my  packet  buffer,  piece  by  piece  if  necessary.  I  may  not 
get  idl  the  bytes  I  need  in  one  read,  so  I  must  wait  for  them  to  arrive. 

* 
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*  ftit  I  should  not  hold  up  other  processing  just  because  I  can’t  get  enou^ 

*  bytes  from  my  port.  So  1  tell  my  caller  that  I’m  not  done  yet.  and  that  I 

*  muM  be  called  again. 

*  1  return  one  of  these  values: 

*  -1  Still  trying  to  g^  a  sanqile,  call  me  again 

*  1  Ok,  got  the  sample 

*  - */ 

int  sim_next_sample(Sun  san^ile  ^sample) 

{ 

static  union 

{ 

Pscket_header  header; 

OrbjMcket  orb; 

Spas_packet  spas; 
ubyte  buffer{48]; 

}  data; 

enum  my_states  {  STATE_find_header,  STATE_read_packet  }; 

static  ubyte  'Hvhere  «  data.buffer; 
static  int  bytes  =  sizeof(P8cket_header); 
static  int  state  s  STATE_find_header; 

static  ubyte  sync  1  [2]  =  {0xeb,0x90},  ^nc2t2]  =  {Oxbe.Oxef}; 

/* - 

Loop  until  I’m  done  or  I  can’t  read  any  bytes. 

*1 

for  (;;) 

{ 

int  got; 

/* - 

*  Try  to  read  as  many  bytes  as  I  need  to  complete  the  buffer.  If  I 

*  get  any  bytes  at  all,  then  bump  the  buffer  pointer  and  drop  the 
bytes-remaining  count.  Return  if  I  can’t  get  enough  on  this  pass. 

*/ 

if  (bytes) 

{ 

if  ((got  =  read(port_file,  where,  bytes))  <  =  0) 

{ 

fix_dos_eof_bug(where); 

break; 

} 


where  +  =  got;  bytes  -=  got; 
if  (bytes  >  0)  break; 


scorn  old.c 


•COB  Old.C 


I* - 

*  If  I’m  in  the  _find_header  atate,  then  check  the  leading  and 
'*  type,  and  get  thr  remaining  packet  aize. 

*! 

if  (state  s  B  STATE  find_header) 

{ 

/♦ - 

*  The  s}mc  is  there,  figure  out  how  many  more  bytea  to  read,  and 
switch  to  the  next  state. 

♦/ 

if  (((ushort  '*)data.  header,  sync  sUrt)[0]  b  s  ((usbort  *)8yncl)[0]) 

{ 

bytes  B  (data.header.type  bs  PKT_orbiter 
?  sizeoftOrbjMck^) 

:  sueof(Spas_packet)); 
bytes  -B  (where  -  data.buffer): 
state  =  STATE  readjjacket; 

} 


/* - 

The  sync  is  not  there.  I'll  search  the  byte  buffer  for  sync  and 
tty  to  recover  a  partial  header. 

*  The  find_syncO  routine  searches  for  sync  and  saves  the  bytes 
that  are  valid,  it  returns  the  number  of  valid  bytes. 

*/ 

else 

{ 

got  B  check_sync(data. buffer,  where  •  data.buffer,  syncl); 
where  =  data.buffer  +  got; 
if  (got) 

{ 

bytes  B  sizeof(Packet_header)  -  got; 
if  (bytes  <  0)  bytes  =  0; 

} 

else  bytes  b  sizeof(PScket  header); 

} 

continue; 


/* - - 

If  I’m  in  the  _read_packet  state,  then  I’ve  got  the  entire  packet. 
Check  the  trailing  sync,  extract  the  usefull  data  and  return  OK. 

*/ 

else 

{ 

Packet_trailer  'Hnuler; 
int  pkt_size; 

I* - 

The  trailing  ^c  location  depends  on  the  packet  type. 
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*1 

if  (data.header.type  »  =  PKT_orbiter) 

{ 

trailer  =  &data.orb.trailer; 
pkt_size  =  sizeof(OrbjMcket); 

} 

else 

{ 

trailer  =  &data.spas.trailer; 
pkt_si2e  =  sizeof(Spas_packet): 


state  =  STATE_find_header; 

The  sync  is  there,  extract  data  depending  on  the  packet  type. 

*1 

if  (((ushort  ■'')trailer-  >  sync_stop)[0]  =  =  ((ushort  •)sync2)[0]) 

{ 

static  int  first_tinie  =  YES; 

if  (data.header.type  =  =  PKT_orbiter) 

{ 

$an^le->ins.pos.x  =  data.orb.orbiter_vector.pos.x  *  FT_TO_KILOM 
sample- >  ins.pos.y  =  data.orb.orbiter_vector.pos.y  *  FT_TO_KILOM 
sample- >iiis.pos.z  =  data.orb.orbiter_vector.pos.z  *  FT_TO_KILOM 
sample- >  ins. vel.x  =  data.orb.orbiter_vector.vel.x  *  FT_TO_KILOM 
sample- >  ins. vel.y  =  data.orb.orbiter_vector.vel.y  *  FT_TO_KILOM 
sample- > ins. vel.z  =  data.orb.orbiter_vector.vel.z  *  FT_TO_KILOM 
sample- >  ins. time  =  data.orb.orbiter_vector.time  -86400.0; 

sample- >quat  =  data.orb.orbiter_quat; 

if  (first  time) 

{ 

sample- >  tans  =  sample- >  ins; 
sample- >  spas  =  sample- >  ins; 
first_time  =  NO; 

} 

} 

else 

{ 

sample- >spas.pos.x  =  data.spas.spas_vector.pos.x  *  FT_TO_KILO\ 
sample- > spas. pos.y  =  data.spas.spas_vector.pos.y  *  FT_TO_KILON 
sample- >spas.pos.z  =  data.spas.spas_vector.pos.z  *  FT_TO_KILOV 
sample- > spas. vel.x  =  data.spas.spas_vector. vel.x  "■  FT_TO_KILOM 
sample- > spas. vel.y  s  (]4ta.spas.spas_vector.vel.y  "■  FT_TO_KILOM 
sample- >  spas. vel.z  »  data. spas. spas_vector. vel.z  FT_TO_KILOM 
sanq>le->  spas. time  »  data. spas.  spas_vector. time  -86400.0; 
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if  (first  time) 

{ 

sample- >  tans  =  sample- >  spas; 
sample- >  ins  >  sample- >  spas; 
sample- >quat.  time  =  sample- >  spas,  time; 
first_time  *  NO; 

} 

} 

where  »  data.buffer; 
bytes  —  sizeof(Packet_header); 
return  I; 

} 

/* - - 

The  sync  is  not  there.  I’ll  search  the  byte  buffer  for  sync  and 
tiy  to  recover  a  partial  packet. 

*! 

got  s  check_^nc(data. buffer,  pkt_size,  syncl); 
if  (got  &&.  got !  =  pkt  size) 

{ 

where  ^  data.buffer  -I-  got; 
bytes  s:  sizeof(Packet_header)  -  got; 
if  (bytes  <  0)  bytes  =  0; 

} 

else 

{ 

where  ^  data.buffer; 
bytes  =  sizeoffPacket  header); 

} 

} 

} 

return  -1; 

} 

*  I  search  for  sync  and  save  the  bytes  that  are  valid,  1  return  the  number  of 
valid  bytes.  I  assume  sync  is  two  bytes. 

*  - 

static  int  check_^nc(ubyte  *buffer,  int  bytes,  ubyte  '"^nc) 

{ 

ubyte  *where; 

for  (where  =  bufler;  bytes  >  1;  where+-l-,  bytes—) 

{ 

if  (((ushort  '•■)wherc)[0]  =  =  ((ushort  *)sync)[0]) 

{ 

menicpy(buffer,  where,  bytes); 
return  bytes; 
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} 

} 

if  (*whefe  =  =  *sync) 

{ 

♦buffer  =  *where; 
return  bytes; 


return  0; 

} 


* - */ 

int  siin_key_handler(int  key)  {  return  YES;  } 

int  siin_edit_display_initO  {  return  NO;  } 

int  sim_edit_key_handler(int  key)  {  return  YES;  } 


scorn  old.c 
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* - */ 

iNnclude  <stdio.h> 

include  <edit.h> 

#include  <jdit_rt.h> 
jKncIude  <times.h> 

^include  <keys.h> 

#include  "siin.h* 


* - *! 

static  FILE 

static  int  siiii_deiay_flag  =  1 ,  sini_delay_ii)s  ~  0; 

* _ */ 

int  sim  init(int  argc,  char  *'*'argv) 

{ 

char  ^filename; 

?  orbj;>ort_iiut_byiiaine(argv[l]) 

:  orbjx>rt_initO); 

filename  =  (argc  >  1  &&  argv[l]  !s  NULL 
?  filename  =  argv[l] 

:  edit_text(”Enter  input  filename:”,  ”sim.dat*)); 

if  ((infile =fopen(filename,  "rb"))  ==  NULL) 

{ 

printf(”Can’t  open  %s\n”,  fikname); 
return  NO; 

} 

return  YES; 


* _ */ 

void  sim_stop0 

{ 

fclose(infile); 

} 
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* -  - */ 

int  sim  next  saiiiple(Sini  sample  ^sample) 

{  "  ■ 

/* - 

*/ 

if  (sim_delay  ms) 

{ 

if  (sim_delay_flag  —as  0)  return  -1; 
sim_deiay_flag  =  0; 

rtc_timer_8et(sim_delay_ms,  &sim_delay_flag); 

} 


/* - 

*1 

if  (fread(sample,  sizeof(Sim_sample),  1 ,  infile)!—  1)  return  NO; 
return  YES; 


* - */ 

int  sim_key_handler(int  key)  {  return  YES;  } 


*-123456789  123456789  123456789  123456789  123456789  123456789 


*  1  SIM  Settings 

*2 

*  3  Realtime  delay  (ms):  X 

*  - */ 


static  Edit_label  labels  IQ  = 

{ 

{  1,20,  "SIM  Settings'}, 

{  3,  4,  "Realtime  delay  (ms):"} 

}: 

^define  LABELl_COUNT  (sizeof(labelsl)/sizeof(Edit_label)) 

static  Edit_field  fields  IQ  = 

{ 

{3,25,  edit_field_get_int,  edit_field_put_int,  edit  field_key  int,  &sim_delay 

}; 

#define  HELD1_C0UNT  (sizeof(fieldsl)/sizeof(Edit_fieId)) 

Edit  screen  screen! 

{ 

LABELl_COUNT,  labelsl, 

FIELDl_COUNT,  fieldsl, 

NULL,  NO,  NULL,  NULL 

}: 
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/♦*« 


•*/ 


static  Edit  screen  ^scieoisQ  s 

{ 

&screenl 

}: 

#define  MAX_SCREENS  (sizeof(screens)/si2eof(Edit_screen  '*)) 


static  int  current_screen; 


* _ */ 

int  siin_edit_display_iaitO 

{ 

edit_screcn_init(screens[cuiTent_screen]); 
return  YES; 

} 


♦ - */ 

int  sim  edit  key  handler(int  key) 

{ 

int  rc  *  edit_screen_key_handler(screens[current_screen3,  key); 
if  (rc  >  0)  return  rc; 

*/ 

switch  (key) 

{ 

case  KEY_pgup; 

if  (-cuiTent_screen  <  0)  current_screen  =  MAX_SCREENS  -  1 ; 
break; 

case  KEY_pgdn: 

if  (++cuiTent_scTeen  >=  MAX_SCREENS)  current_screen  =  0; 
break; 

default:  return  NO; 

} 

edit_screai_init(screais[curTent_screen]); 
return  YES; 
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(include  <edit.h> 
#include  "sim.h'' 


♦ - */ 

static  FILE  *infilel ,  ''4nfile2; 


char  ^filenamel,  ^filenamel; 


filenamel  »  edit_text(‘'Enter  input  filename:*,  ‘sim.dat*); 
if  ((infile l=fopen(<ilenaniel,  "rb"))  ==  NULL) 

{ 

printf(’Can't  open  %s\n*,  filenamel); 
return  NO; 

} 

filename2  =  edit_text(”Enter  input  filename:*,  ”tans_sa.dat*); 
if  ((infile2=fopen(fileoame2,  *r*))  ss  NULL) 

{ 

pnntf(*Can*t  open  %s\n*,  fileoame2); 
return  NO; 

} 

return  YES; 

} 


void  sim_stopO 

{ 

fclose(infilel); 

fclose(inEle2); 

} 


♦WARNING: 

♦  I  assume  the  ORB_GPS  and  ORB_INS  vectors  are  propagated  more  often  than  the 
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*  SPAS  vector.  I  lue  tbe  very  first  SPAS  tuse  as  die  bese/starting  time. 

*  - */ 

int  aim  next  aaiiiple(Sim  sample  ^aaiqile) 

static  double  iiiitial_time; 
static  first_time  •  YES; 

int  cnt; 

/* - 

*/ 

if  (fread(sample,  sizeof(Sim_sample),  1 ,  infilel)  !»  I)  return  NO; 

cnt  =  fscanf(infile2,‘‘%if  %lf  %lf  %lf  %if  %If  %if*,  &sample->orb_gps_mSO.time, 
&sample->orb_gps_m50.pos.x,  &sample->orb _gps_m50.pos.y,  &sample->orb _gp8_m50.pos.z, 
&sampie->orb_gps_mSO.vel.x,  &sample->orb_gps_m50.vei.y,  &sample->orb _gps_m50.vel.z); 

if  (cnt  <  7)  return  NO; 

/* - 

if  (first  time) 

{ 

initial_time  s  san4>le->  spas,  time; 
first  time  =  NO; 

} 

sample- >orb_gps.  time  +=  initial_time; 
return  YES; 

} 


int  sim_key_handler(mt  key)  {  return  YES;  } 

int  sim_edit_display_initO  {  return  NO;  } 

int  sim_edit_key_handler(int  key)  {  return  YES;  } 


•disk  2.C 


•disk  2.C 


* - *! 

#include  <stdio.h> 

#include  <edil.h> 

#include  ”siin.h'' 


* - */ 

static  FILE  ^infilel,  *infUe2; 


* - ♦/ 

int  siin_initO 

{ 

char  "‘fileoaniel,  '*iileiiaiiie2; 

fUenamel  ^  edit_text(‘'Enter  input  filename:'',  'sim-dat"); 
if  ((infilel  »fopen(filenamel,  "fh*))  ==  NULL) 

{ 

printfCCan’t  open  ^sXn",  filenamel); 
return  NO; 

} 

filename2  »  edit_text(''Enter  input  filename:",  "tans_sa.dat*); 
if  ((infi]e2=:fopen(filename2,  "r"))  ==  NULL) 

{ 

printff’Can’t  open  %s\n*,  filenanie2); 
return  NO; 

} 


return  YES; 

} 


* - */ 

void  sim_stopO 

{ 

fclosefinfilel); 

fcIose(infile2); 

} 


*  WARNING: 

*  I  assume  the  ORB_GPS  and  ORB_INS  vectors  are  propagated  more  often  than  the 
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*  SPAS  vector.  1  use  the  veiy  first  SPAS  dme  as  the  baae/startuig  time. 

*  - */ 

int  sim  iiext_iuople(Sim  su^le  ^sample) 

{ 

static  douMe  iiiitial_time; 
static  first_tiiiie  s  YES; 

int  cot; 

I* - 

*1 

if  (freadfsample,  sizeof(Sim_aample),  1 ,  infilel)  !s  i)  return  NO; 

cnt  »  fscanf(infile2,''%if  %lf  %lf  %lf  %lf  «lf  «ir.  &saniple->orb_gps_inSO.tiine, 
&sainple->orb_gps_m50.pos.x,  &saiiiple'>orfo _gps_in50.pos.y,  &sainple->orb _gps_inSO.pos.z. 
&sainple->orfo_gps_inSO.vel.x,  &sainpie->orb_gps_mSO.vel.y.  &sainple->orb_gps_mSO.vel.z); 

if  (cnt  <  7)  return  NO; 

/* - 

*/ 

if  (first  time) 

{ 

initia]_time  =  sample- >  spas,  time; 
first  time  «=  NO; 

} 

saii^>le->orb_^».time  +«  initial_time; 
return  YES; 

} 

* _ 

int  sim_key_handier<int  key)  {  return  YES;  } 

int  sim_edit_display_initO  {  return  NO;  } 

int  sim_edit_key_handler(int  key)  {  return  YES;  } 
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#iiiclude 
iKnclude 
#iiiclude 
#iiiclude 
iKnclude 

#include  "sim.h'' 

#include  <keys.h> 

#iiiclude  <nps_if.h> 

extern  unsigned  _stklen  =  ISOOOU;  //larger  stack 


<8tdUb.h> 
<stdio.h> 
<conio.h> 
<  bios.h  > 
<ti0ie.h> 


* - */ 

static  int 

nuun_key_handler(int  key); 

static  void 

key_process(  void) , 

nuun_display_init(void), 

inain_display_status(void); 

static  int  (’'‘my_key_handlerKint)  =  niain_key_handler; 
static  int  terminate  =  NO,  suspended  =  YES; 


* _ ♦/ 

void  main(int  argc,  char  ""'tegv) 

{ 

long  cnt; 

int  got_stop_time; 
long  start_time,  stop_time; 
double  iun_time; 

/* - 

*! 

cIrscrO; 

if  (sim  init(argc,  argv)  =  —  NO) 

puts(”sim_initO  iiuled  during  init”); 
return; 
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} 

if  (aps  ^stem_iiiitO  =  *  NO) 

{ 

puts(*iips_^stein_iiiitO  failed  during  init*); 
return; 

} 

if  (gen  initO  *  *  NO) 

{ 

puts(*gen_initO  fiuled  during  inif); 
return; 

} 

start_time  =  biostime(0,  0); 
got_stop_time  =  NO; 

nuun_display_initO; 

*! 

for  (cnt  =0;  ;  ) 

{ 

static  Sim_saniple  sample; 
int  rc; 

/* - 

*  Check  for  key  hit,  process  the  key,  see  if  somebody  wants  to  stop 

*  the  program. 

*! 

if  (key_hit()) 

{ 

key_processO; 
if  (terminate)  break; 

} 

if  (suspended)  continue; 

/* - 

*  Get  next  sample,  call  all  data  update  routines.  The  _next_sample 
routine  must  return  one  of  these  values: 

-1  Still  trying  to  get  a  saa^>le,  call  me  again 

*  0  Done,  no  more  samples  available  (usually  from  disk_sim) 

1  Ok,  got  the  sample 

*1 

if  ((rc  *  sim_next_sample(&sample))  <  1) 

{ 

if  (rc  <  0)  continue; 
if  (got_stop_time  =  =  NO) 

{ 

sia.c 
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sU^_tiiiie  *  biostiiiie(0,  0); 
got  stop_tiiiie  =  YES; 

) 

C(»tinue; 

} 

cnt+  + ; 

Dps_data_update(&saiiiple.oit>_uis,  &su:iple.OTb_quat,  &suiq>le.orfo_taig, 
&sanq>le.orb_gps_inSO,  &sample.orb_^_ecef, 

&sainple.spas_sv,  Aaample.spas  gps): 
gen_ave_suiiple(&ttniple); 

/♦ - 

This  chunk  is,  in  effect,  the  nudn_data_updateO  routine. 

*/ 

if  (my  key_handler  ^  =  main  key  handler) 

{  ' 

gotoxy(ll,  20);  cprintf(''%7ld",  cnt); 

} 

} 

if  (got_stop_tinie  =  =  NO)  stop_time  =  biostimefO,  0); 
nin_time  =  (stopjime  -  startjime)  /  CLK_TCK; 

gai_stopO; 

nps_system_stopO; 

sim_stopO; 

printf("\n\nDid  %ld  vectors  in  %lf  secs,\n'',  cnt,  nin_time); 
printfC  That’s  %lf  vectors  per  secXn”,  (double)cnt  /  run_time); 


* _ */ 

static  void  key_processO 

{ 

int  rc,  key  =  key _ietO; 

re  =  (*my_key_handler)(key); 

if  (rc  =  =  2) 

{ 

my_key_handler  =  main_key_handier; 
main_display_init0; 

} 

if  (rc  =  =  0) 

{ 

if  (key  ==  KEY_alt  s) 

{ 

sim.c 
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suspeoded  »  (suspended  ?  NO  ;  YES); 
oiaiii_di^iay_statusO; 

} 

else  sim  key  handlerCkey); 

) 

} 


*  Returns: 

0  Didn't  use  the  key 

*  1  Used  the  key 

2  Used  the  key,  My  subsystem  is  done 

-ti - */ 

static  int  main_key_handler<int  key) 

{ 

switch  (key) 

{ 

case  KEY_esc: 

terminate  =  YES; 
return  YES; 

case  KEYJl: 

if  (sim_edit_display_init()  =  =  YES) 

my_key_hjuidler  =  sim_edit_key_handler; 
break; 

case  KEY_f2: 
sim_stopO; 
nps_data_flushO; 
clrscrO; 

if  (sim_init(0,  NULL)  =  =  NO)  terminate  =  YES; 

main_display_itiitO; 

break; 

case  KEY_f3: 
nps_data_flushO; 
break; 

case  KEY_f6: 

if  (nps_display_initO  ==  YES) 

my_k^_handler  =  nps_key_handler; 
return  YES; 

} 

return  NO; 
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typedef  struct  {  int  col,  row;  char  'Hext;  }  Label; 

static  void  main_display_initO 

{ 

static  Label  labelsQ  = 

{ 

{16,6,  "Simulator  Main  Menu"}, 

{  6,  8,  "ALT-S  Start/Stop  the  sim  (toggle)"}, 

(  6,10,  "FI  Sim  settings"}, 

{  6,11,  "F2  Restart  Sim"}, 

{  6,12,  "F3  Clear  prev  Sim"}, 

(  6,13,  "F4-}, 

{6,14,  "F5"}, 

{  6,15,  "F6  NFS  Plots"}, 

{  6,17,  "ESC  Exit"}, 

{  2,20,  "Cycles;  "}, 

{  0,0,  NULL  } 

}; 

Label  ''‘label; 

/* - 

*! 

clrscrO; 

for  (label  =  labels;  label- >  text  !=  NULL;  label -1- -I- ) 

{ 

gotoxy(label-  >  col ,  label-  >  row) ; 
cputs(label-  >  text); 

} 

main_display_statusO; 


static  void  main  display  statusQ 

{ 

if  (my_key_handler  !=  main_key_handler)  return; 
gotoxy(2,  19); 

cputs((suspended  ?  "(halted)  "  ;  "(running)")); 

} 
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- - T _ --T— .-.wTr _ - 

(Wfhdcf  _SIM_ 

#defuie  _SIM_ 

^include  <orbmechl.h> 
^include  <  vector.  h> 


•*/ 


This  structure  is  passed  from  the  simulator  code  to  the  main  routme.  This 
is  also  the  structure  used  in  disk  read/writes. 

- */ 

typedef  struct 

{ 

State_vector  orb  gps  mSO,  orb_gps_ecef,  spas_gps,  spas_sv,  orb_ins,  orb_targ; 
Quaternion  orb  quat; 

}  Sim  sample; 

/♦ - 

extern  int 

sim_init(int  argc,  char  ■*'*argv), 
sim_edit_display_init(void), 
sim_edit_key_handler(int), 
sim_key_handler(int), 
sim_next_sample(Sim_sample  '^'sample); 

extern  void 

sim_stop(void); 


/• - */ 

extern  int 

gen_init(void); 

extern  void 

gen_save_sample(Sim_sampIe  ’"sample), 
gen_stop(void); 

#endif  SIM 


sim.b 


* - */ 

finclude  <ttdio.h> 

{Knclude  <alloc.h> 

^include  <edit.h> 

#iiiclude  "sim-h" 


* - */ 

#deftne  MAX_SAMPLES  (OxfffT  /  tizeof(Sim_ttinple)  >1) 


typedef  struct  mem  buffer 
{ 


struct  _mem_buffer  *next; 
int  count; 

Sim_sainple  saiiq)les[MAX_SAMPLES]; 
}  Mem_buffer; 


static  Mem_bufrer  "'buffer^first,  '^buffer_curreot; 
static  Sim_aample  ‘*'san4>le_next; 
static  int  sample_cnt; 


/*= 


• - ♦/ 

int  sim_initO 

{ 

char  ^filename; 

HL£  ■^infile; 

int  samples; 

Mem_bufrer  '•‘buffer,  '•1)uffer_prev; 

I* - 

*! 

filename  «  edit_text(*Enter  input  filename:*,  *sim.dat*); 

if  ((infileaefopenffilename,  *rb*))  ««  NULL) 

{ 

printf(*Can’t  open  %s\n*,  filename); 
return  NO; 

} 


/* - 

*/ 

fseek(infile,  OL,  SEEK_END); 


c 


aan^ilet  ■  (iDtXftdl(infile)  /  MzeofitSini^sample)): 

samples  >  edit_integer(''How  many  samples  should  I  load:*,  san4>les); 

if  (smnples  <  »  0) 

{ 

fcloae(uifUe); 
letura  NO; 

} 

fseek(mfile,  OL,  SEEK_SET); 

I* - 

*! 

for  (bufferjjrev  «  NULL; 
samples  >  0; 

samples  MAX  SAMPLES,  buffer_prev  ^  buffer) 

{ 

if  ((buffer  «  malloc(sizeof(Mem  buffer)))  « «  NULL) 

{ 

printf(*Ran  out  of  memoty,  %d  samples  iemainiog\n*,  samples); 

fclose(mfile); 

return  NO; 

} 

if  (buffer_first  *  «  NULL)  buffer_first  **  buffer; 
else  buffer_prev>  >  next  «=  buffer; 

buffer*  >  next  »  NULL; 

buffer- >  count  »  fTead(buffer->  samples,  sizeof(Sim_sample),  MAX_SAMPLES,  infile); 
if  (buffer- >  count  <9^  0)  samples  =  0; 


*/ 

buffer_cuiTent  buffer_first; 
sample_ait  s  buffer_current->  count; 
sample_next  buffer_current- >  samples; 

fclose(infile); 
return  YES; 


* - ♦/ 

void  sim_stop0  {  } 


/*! 


int  rim  next  8unple(Sim  sample  ^teo^ile) 

{  "  ■ 

/* - 

•/ 

if  (buiTer_cuiTent  «  »  NULL)  return  NO; 

^sample  «  Haiiq>le_next-f  +  ; 

if  (—sample  cnt  <  »  0) 

{ 

buffer_cuiTent  «  buffer_cufTent*>next; 
if  (buffer  current  ! »  NULL) 

{ 

sample_cnt  =  buffer_cuiTent- >  count; 
sample  next  s  buffer  current- >  samples; 

} 

return  YES; 


1* _  .  -  . .  .  - - - _ 

int  sim_key_handler(int  key)  {  return  YES;  } 

int  sim_edit_display_initO  {  return  NO;  } 

int  sim_edit_key_bandler(int  key)  {  return  YES;  } 


ntto&.c 
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• - *! 

iKoclude  <itdio.h> 

Maclude  <itdlib.h> 
i^Iude  <iiiath.h> 


fiaclude  <edit_rt.h> 
inaclude  <keys.b> 

#iiiclude  <tiiDes.h> 
finclude  "sim.h* 

Moclude  ’../nps/nps_iiiSO.h‘' 


/*. 


* - •/ 

tUtic  Sute_vector  tans,  spas,  orb_ins,  noi^_spas,  Doi^_tans,  hold_tans; 
static  Quateraion  orb_quat; 

static  double  tans_delta_t,  tans_step; 
static  double  spas_delta__t,  spas_step: 
static  double  orb_iiis_delta_t,  orb_ins_step; 
static  Vector  r_variance,  v_variance; 

static  Perturbations  far  tans_P,  ^  orb_P,  far  spas_P; 

static  double  impulse  «  2.0*0.00003048,  tinie_to_mdv,  dv2_time; 
static  Vector  delta_v2; 

static  int  mdv_in_progress,  spas_noise,  tans_noise,  tans_running  ^  YES; 
static  int  sim_deiay_flag  »  1 ,  sim_delay_nis  »  0; 


/■*■&  s  as  s  s  3 


* - */ 

Static  void 

tfarust(State_vector  *,  State_vector  *,  Vector  *,  Vector  *,  Perturbations  *), 
rdvz_deita_v(State_vector  *,  State_vector  *,  double.  Vector  *,  Vector  *,  Perturbations  *), 
getquat(void); 

static  int 

testqtiat(Vector  *,  Vector  *,  Vector  *); 


#define  Julian  date  2000  2451545.0 

* - 1 - 1 - *! 

int  aim  init(int  argc,  char  **Mrgv) 

{ 


•prop.c 
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/* - 

*/ 

tens-Ume  -  ((((210  •  24)  +  2)  •  60.0)  +  15)  *  60.0  +  0.0; 
tins.pof.x  B  6600.0;  tans.pos.y  «  0.0;  tans.pot.z  »  0.0; 
tans.vel.x  *  0.0; 

tans.vel.y  tqrt(3.9860064e-f5/vector_niagnitude(lUans.pos))*f0.0; 
taiis.vd.z  *  0.0; 

tans_delu_t  *  10.0;  Uns_ttep  «  10;  /*  step  size  (lec)  */ 

tiine_to_rndv  m  un$_delU_t'^doubleK(inC)(4020.0/Uiis_delU_t)); 

/♦ - 

•/ 

spas.time  -  tans.time; 

qMu.pos.x  s  6600.0;  spu.pos.y  «  0.0;  spas.pos.z  »  0.0; 
s{>as.vel.x  »  0.0; 

spas.vel.y  b  sqrt(3.9860064e*f  S/vector_magmtude(&spas.pos)); 
qias.vel.z  0.0; 

spas_delu_t  *  45.0;  spas_step  =  10; 

/♦ - 

*/ 

orb_ins.tiine  »  tans.time; 

orb_ins.pos.x  »  6600.0;  orb_ins.pos.y  =  0.0;  orij_ins.pos.z  =  0.0; 
orb_ins.veI.x  ■*  0.0; 

orb  ins.vel.y  »  sqrt(3.9860064e+5/vector_magnitude(&tans.pos))-f0.0; 
orb_ins.veI.z  =  0.0; 

orb_ins_delta_t  *  10.0;  orb_iiis_stq»  =  10;  /♦  step  size  (sec)  */ 

/*__ - 

*1 

tans_P.  Drag,  mode  =  ON; 
oib_P.  Drag,  mode  »  OFF; 

■pas_P. Drag. mode  »  ON; 

tans_P.Drag.soIar_flux  * 
oib_P.Drag.aolar_flux  « 
apas_P.Drag.soiar_flux  *  185.9593403793603; 

tans_P.Drag.mean_soh-_flux  » 
orb_P.Drtg.meao_aolar_fliix  » 
spas_P.Drag.mean_aolar_flux  *  178.6447698684861; 
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laiu_P.Dng.(eoiiiagnetic_iiMkx_ap  * 
CMi>_P.Drig.geoisifiielic_iiidex_ap  * 
tpas_P.Drag.geoiiiagDeUc_iiidex_ap  >  19.87811961456716; 

Uiis_P.Dnig.b«llistic_ouiDber  »  64.0; 
orb_P.Dras.tMllisUc_nuiiiber  b  64.0; 
ipas_P.Dng.ballittic_nuiiiber  64.0; 

Uuis_P.Gnvity.nuii)ber_zoiuU  *  6; 
orb_P.GniviQ^.DUiiiber_xoiMl  *  4; 
^as_P.Gnvity.Duoiber_zoiial  «  6; 

tans_P.Gnvity.number_tessenl  «  6; 
orb_P.Gnvity.Bumber_tessenl  »  4; 
spa$_P.Gravity.Duinber_tessenI  «  6; 

instantiate_gotpot(l,  &Uns_P); 
insuntiate_gotpot(l,  &orb_P); 
instantiate_gotpot(l,  &spas_P); 

if  (bgprop_^iiutO  *  *  NO)  return  NO; 

*1 

getquatO; 
return  YES; 

} 


void  sim  stopO 

{ 

} 


•*/ 


* - ♦/ 

int  siin_iiexl  aainple(Siin  sample  ^sample) 

{ 

State_vector  teiiip_wgs84,  tempJTOOO; 

/* - 

*/ 

if  (sim  delay  ms) 

{ 

if  (sim_delay_flag  0)  return  -1; 
sim_delay_flag  «  0; 

rtc_timer_set(sim_delay_ms,  &sim_delay_flag); 


•prop.c 
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) 


/♦ - 

*/ 

if  (nidv  io_pfogren  &Sl  tans.Uine  >  ■  dv2  time) 

I 

tans.vel.x  delu_v2.x; 

taiis.vel.y  delu_v2.y: 

tans.vel.z  delta_v2.z; 

orb_iiis.veI.x  deltz_v2.x: 

OTb_ins.vel.y  -■  delu_v2.y; 
ori>_ins.vel.z  deiu_v2.z; 
mdv  m_pn>gress  *  NO; 

) 


/* - 

*  Note  that  the  tans.pos  and  tans.vel  vectors  are  used  for  input  AND  for 

*  output,  this  is  ok  with  the  current  version  of  bgpropQ. 

*/ 

bgprop(tans.tinie,  &tans.pos,  &tans.vel,  &tans_P,tans_delta_t,tans_stq>,  dlUans.pos,&tans.vel); 
tans.time  -f  »  tans_delta_t; 

/* - 

*1 

if  (spas.time  ■+  spas  delta  t  <  s  tans.time  tans  delta  t) 

bgprop(spas.time,  &spas.pos,&spas.veI,  &spas_P,spas_delta_t,spas_step,  &spas.pos,&spas.vel); 
spas.time  -f  =  spas_delu_t; 


/* - 

*! 

bgprop(orb_ins.tinie,  &orb_ins.pos,  &orb_ins.ve), 
&ort)_P,orb_ins_delta_t,oib_ins_8tep,  &orb_ins.pos,&orb_ins.vel); 
orb_ins.time  +=  orb_ins_delta_t; 

/♦ - 

*/ 

if  (tans  noise) 

{ 

r_vanance.x  pow((doubleKnodoiD(](XX))*500)/5(X).0,  3.0)  .2; 
r_variance.y  «  pow((doubleXnuidoin(l(X)0)-S(X))/S(X).0,  3.0)  *  .2; 
r_varianee.z  s  pow((doubleXTandom(](X)0)>500)/S(X).0.  3.0)  *  .2; 
v_variance.x  »  pow((doubleXnndoiD(10(X))-300)/500.0,  3.0)  .001; 
v_variance.y  »  pow((doubleXnDdom(10(X))>500)/S(X>.0,  3.0)  *  .001; 
v~variance.z  «  pow((doubleXnuidom(1000)-S00)/S00.0.  3.0)  *  .001; 


noisy_tans.pos.x  r_variance.x  +  tans.pos.x; 
iioisy_tans.pos.y  «  r_variance.y  tans.pos.y; 
Doi^_tans.pos.z  •  r_variance.z  +  tans.pos.z; 
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iioisy_Uuu.vel.x  ■>  v_vafMi>ce.x  tans.vel.x; 
iioi^_taiu.veI.y  »  v_varuuice.y  4-  tans.vel.y; 

Boi^  taiis.vel.z  •  V  varMiice.z  -f  Uos.vel.z: 

} 

cite 

{ 

iioi^_toiu.pot  B  tans.pos; 

Boi^  taBt.veI  *  taas.vei; 

) 

Boi^_taBs.time  «  Uns.time: 

if  (tans_nuining  ■>  •  YES)  hold_taBS  >  Boi^_Uns; 

/*. - 

*! 

if  (spas  noise) 

{ 

r_variance.x  »  pow((doubie)(randoin(l000)-S00)/S(X).0,  3.0)  *  .2; 
r_variance.y  b  pow((doub)eXnndoin(1000)'S00)/S(X).0,  3.0)  *  .2; 
r_variance.z  *  pow((doubleXrandom(l(XX))-S(X))/S00.0,  3.0)  *  .2; 
v_variance.x  *  pow((doubleXfandom(l000)-500)/S(X).0,  3.0)  .001 

v_variance.y  *  pow((double)(randoin(I000)-500)/5(X).0,  3.0)  *  .001 
v_variance.z  b  pow((doubleXnndom(1000)-S00)/S(X).0,  3.0)  *  .001 

noi^_q>as.pos.x  »  r_variance.x  4-  spas.pos.x; 
noisy_5pas.pos.y  *  r_variance.y  4-  ^^Ms.pos.y; 
noi^^spas.pos.z  b  r_variance.z  4-  spas.pos.z; 
noisy_q)as.vel.x  b  v_variance.x  4-  qus.vel.x; 
noi^_spas.vel.y  b  v_variance.y  4-  spas.vel.y; 
noisy  spas.vel.z  b  v_variance.z  4-  spas.vei.z; 

) 

else 

{ 

noisy_spas.pos  b  spas.pos; 
noi^  spas.vel  b  spas.vel; 

> 

noiqr_spas.tiiDe  b  spas,  time; 

/*- — . — - 

*/ 

tetquatO; 

aaBq>le->ofb_tafg  b  qiu; 
saog>le->otb_ins  b  orb_ins; 
sample- >orb_quat  b  orb_quat: 

#  ifdefNPS_GPS 

Ieiiq>_wgs84  b  aoi^_§pas; 
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ii|»_inS0_to_wgs84(&teo4>_wgs84,  NPS_MSO_coiiiputed.  NO); 
aainple->qws _gps  •  teiiip_wgs84; 

teii4>J2000  «■  Doi^_i|Ms; 
nps_iiiS0_toJ2000(&taiipJ2000); 

■uiiple->*pu_iv  K  len9j2000; 

sunple->orb jgpt_iiiSO  «  bold_taiis; 
teiiip_wgs84  ■>  iiold_Uuis; 

iips_mS0_to_wgs84(^iiip_wgs84.  NPS_MSO_computed,  YES); 
saiiiple->orb _gps  ecef  »  temp  wgs84; 

#  endifNPS.GPS  ~ 

r^m  YES; 

} 


* - */ 

int  sim  key  bandler(int  key) 

{ 

//  static  char  work[32]; 

Vector  deltavjvlh,  deItav_M50,  delta_vl; 

int  new_rDdv_flag  =  NO; 

/♦. - 

*1 

switch  (key) 

{ 

case  KEY_alt_fl; 

orb_ins  —  tans;  //orb_ins  update 

break; 

case  KEY_alt_f2:  //TANS  running  toggle 

taiis_running  »  (tans_running  ?  NO  :  YES); 
break; 

case  K£Y_aIt_f3:  //TANS  noise  toggle 

tans  noise  «  (tans  noise  ?  NO  :  YES); 
break; 

case  KEY_alt_f4:  //SPAS  noise  toggle 

q>as_iioi8e  «  (spas_noise  ?  NO  :  YES); 
break; 

case  KEY_alt_f5:  //positive  ’v’ 

deltavjvih.x  «  impulse;  deltavjvlh.y  «  0.0;  deltavjvlh.z  =  0.0; 
thrust(&spas,  &tans,  &deltav_lvlh,  d(deltav_M50,  &^as_P); 
tans.vel.x  -f  »  deItav_MS0.x; 
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ttns.vd.y  •  dduv_M50.y; 

Uuu.vel.z  deltav_M50.z; 
orb_int.vel.x  ■■  ddUv_MSO.x; 
orb_iiis.vel.y  +“  deIuv_M50.y; 
orb_iiis.vel.z  deltzv_M50.z; 
break; 

cate  KEY_aIt_«:  //negative  ’v* 

deltav  Ivlh.x  ■  'iii^Hilte;  deltav_lvlh.y  “  0.0;  deltav_lvlh.z  «  0.0; 
tbfu«t(AjpM,  JUani,  AdelUv_lvUi,  &deltav_M50,  &^xas_P); 

tans. vel.x  4  b  deItav_M50.x; 

tant. vd.y  4*  deltav_MS0.y; 
tans.vel.z  4  b  deltav_MS0.z; 
orb  int.vel.x  4*  deltav_MS0.x; 
orb  ins.vel.y  4«  cleltav_M50.y; 
orb  ins.vel.z  4  b  deltav_MS0.z; 
breidc; 

case  KEY  alt  f7;  //positive  ’r’ 

deltovJvUTx  b  0.0;  deluvjvlh.y  b  0.0;  deltavjvlh.z  «  impulse; 

thrust(&spas,  ditans,  dcdeltav_lvlh,  &deltav_M50,  dcspas^P); 

tans.vel.x  4  b  deltav_MS0.x; 

tans.vel.y  4*  deltav_MS0.y; 

tans.vel.z  4*  deltav_MS0.z; 

orb^ins.vel.x  4  b  delUv_M50.x; 

orb_ins.ve!.y  4*  deItav_M50.y; 

orb  ins.vel.z  4  b  deltav__MS0.z; 

brei; 

case  KEY  alt  f8;  //negative  Y 

deluvjvihix  B  0.0;  deluvjvlh.y  =  0.0;  deluvjvlh.z  »  -impulse; 

dmist(&q>as,  dttans,  AdelUv  Ivlh,  &deluv_M50,  &spas_P); 

tans.vel.x  4  b  delUv_MS0.x; 

tans.vel.y  4“  delUv_M50.y; 

tans.vel.z  4  b  delUv_M50.z; 

orb_ins.vel.x  4*  delUv_MS0.x; 

orb_ins.vel.y  4  b  deluv_MS0.y; 

orb  ins.vel.z  4  b  delUv_MS0.z; 

breidc; 

case  KEY_alt_f9:  //increase  ’delu  v’ 

impulse  4  b  0.00003048; 

//  tetcolor(0); 

//  outuxtxy(80,80,  work); 

//  q>rintf(work,  %6.2r,  iinpulse/0.0003048); 

//  setcolor(7); 

//  outtextxy(80.80.  woric); 
break; 

case  KEY_alt_fl0:  //decrease  ’delu  v’ 
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impulse  •«  0.00003048; 

//  setcoloKO); 

//  oiittextxy(80,80.  work); 

//  spriiitf(work,''%6.2r.  impulse/0.0003048); 

//  setcolor(7); 

//  outtextxy(80,80,  work); 
break; 

case  KEY_alt_r:  //secret  stuff 

rdvz_delta_v(&spas,  Ataos,  time_to_mdv.  &delta_vl,  &delta_v2,  &spas_P): 

tans.vel.x  +■  (ielu_vl.x; 

tans.vel.y  -f  delta_vl.y; 

tans.vel.z  -t-»  deiu_vl.z; 

orb_ins.vel.x  +*  delta_vl.x; 

orb_ins.vel.y  delta_vl.y; 

orb_iiis.vel.z  +*  delta_vl.z; 

dv2_time  »  tans.time  +  tinie_to_™dv; 

new_mdv  flag  =  YES; 

break; 


default: 

new_mdv_flag  *  rDdv_iii_progress; 
break; 

} 

mdv_injprogress  =  new_mdv_flag; 
return  YES; 


These  are  helper  routines  for  the  edit  screens  below.  These  routines  help 
'*  by  copying  one  just>set  variable  to  others  that  must  be  the  same  value. 

* - */ 

static  int  drag  fields_put(char  ^ork,  void  '*'data) 

{ 

edit_fieid_put_dbl(work,  dau); 

if  (data  »  »  &otb_P.Drag.aolar_fIux) 
tans_P.Drag.solar_flux  « 
spas_P.Drag.solar_fiux  s  orb_P.Drag.solar_flux; 
else  if  (data  dlu>rb_P.I>rBg.mean_solar_flux) 
taos_P.Drag.mean_solar_flux  « 

spas_P.Drag.mean_solar_fIux  »  orb_P.Drag.inean_solar_flux; 

else 

tans_P.Drag.geomagnetic_index_ap  « 

spas_P.Drag.geomagnetic_index_^;>  «  orb_P.DrBg.geomagnetic_iodex_^>; 
return  YES; 

} 
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tutic  iot  init  coodsjpuUehw  *work,  void  *daU) 

{ 

edit_fieldj>ul_dbl(work,  daU); 
if  (data  •  •  &taiu.poa.x) 

apas.poi.x  »  orb_ins.pos.x  «  taiu.pm.x; 
eiw  if  (data  ** »  &taiu.pos.y) 

q)as.pos.y  «  ort>_iiis.pos.y  *■  tans.pos.y; 
else  if  (data  ■■  »  &taiu.pos.z) 

spu.pot.z  ■  ofb_iiu.pos.z  «  taas.pos.z; 
else  if  (data  *  «  &taiis.vel.x) 

spas.vel.x  »  orb_iiu.vei.x  •  tans.vel.x; 
else  if  (data  dUans  vel.y) 

spas.vei.y  »  orb_ins.vel.y  »  tans.vel.y; 

else 

spas.vel.z  »  orb_iiis.vel.z  *  tans.vel.z; 
return  YES; 


static  int  init  tiinej}Ut(char  'Nvork,  void  '^data) 

{ 

edit_field_put_dhinsl(work,  data); 
spas.time  —  orb_ins.tiiiie  -  tans.time; 
return  YES; 


static  int  orb  ballistic_put(char  'Nvork,  void  *data) 

{ 

edit_field_put_dbl(work,  daU); 

tans_P.Drag.balli8tic_nuniber  «  orb_P.Drag.baliistic_oumber; 
return  YES; 

} 
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•5 
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♦6 
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*7 
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*8 

*9 
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Solar  Flux:  X 

Alt-F8  Thrust  -R 

*12 

Mean  Solar  Flux:  X 

Alt>F9  Inc  delta-v 

*13 

*14 

*15 

Geomagnetic  Activity  Index:  X 

Ait'FlO  Dec  delta-v 
Alt-R  Rendezvous 

TANS 
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*16  SIM  Initial  Conditons 

*17  Position  (km)  VdociQ^  (km/s) 

*18  x:  X  vx:  X 

y:  X  vy;  X 

*:  X  vz:  X 

Time  (ddd/lih:mm:ss):  DDD/HH:MM;SS 

Realtime  delay  (ms):  X 

static  Edit  label  labelslQ  « 

{ 

{  1,20,  *SIM  Profiagation  Perturbations*}, 

{  3,  3,  *Orb  TANS  SPAS"}, 

{  4,24,  "Drag  mode  on*}, 

{  5,24,  "Ballistic  number"}, 

{  6,24,  "Zonal  harmonic*}, 
j  7,24,  "Tesseral  harmonic*}, 

{  8,24,  "Noise  mode  on*}, 

{10,  4,  "Drag  Information*}, 

{11,  6,  "Solar  Flux:*}, 

{12,  6,  "Mean  Solar  Flux:"}, 

{13,  6,  "Geomagnetic  Activity  Index:*}, 

{  3,47,  "Sim  Keys:*}, 

{  4,49,  *Alt-Fl  Orb-INS  =  TANS"}, 

{  5,49,  *Alt-F2  TANS  on/ofT}, 

{  6,49,  *Alt-F3  TANS  noise  on/ofT}, 

{  7,49,  *Alt-F4  SPAS  noise  on/off"}, 

{  8,49,  "Alt-F5  Thrust  +V*}, 

{  9,49,  *Alt-F6  Thrust  -V"}, 

{10,49,  "Alt-F7  Tirust  +R"}, 

{11,49,  *Alt-F8  Umist-R’}, 

{12,49,  "Alt-F9  Incdelu-v*}, 

{13.49,  "AH-FIO  Dec  delu-v"}, 

{14,49,  "All-R  Rendezvous*}, 

{16,20,  "SIM  Initial  Conditions*}, 

{17,  4,  "Position  (km)  Velocity  (km/s)*}, 

{18.  6,  -x:*}, 

{18,37,  "vx:"}. 

{19,  6.  *y:*}, 

{19,37,  "vy:"}, 

{20,  6,  "z:"}. 

{20,37,  -vz:*}, 

{22.  4,  "Time  (dddAih:mm:ss):*}, 

{24,  4,  "Realtime  delay  (ms):"} 

); 

fdefine  LABELl_COUNT  (sizeof(labelsl)/sizeof(Edit_label)) 

static  Edit  field  fieldslQ  » 

{ 

■prop.c 
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{  4,  5,  edit_field _get_yesiio,  edit_field_put_^esno,  edit_field_key_yesno,  &ori)_P.Dng.iDode  }, 

I  4,12,  edit_field _gct _yesiK),  edit_fieldj>ut_yesno,  edit_field_key_yenio,  &taiis_P.Dng.inode  }, 

{  4,19,  edit_field_get_yesno,  edit_field_pul_yeiao,  edit_field_key_yesno,  &spts_P. Drag. mode  }, 

{  5,  8,  fldit_,field _fet_dbl,  orb_btlliftic_put,  edit_field_k^_dbl,  &orb_P.Drag.balliMic_number  }, 

{ S,18,  edit_field _get_dbl,  edit_field_put_dbl,  edit_field_key_dbl,  dlcsp«s_P.Drag.billistic_number  }, 

{  6,  S,  edit_fidd _get_int,  edit_field_put_int,  edit_field_key_iiit,  du>rb_P.Gravity.number_ziHiaI  }, 

{  6,12,  edit_field_ge(_tBt,  edit_field_put_iBt,  edit_{ield_key_ut,  &Uns_P.Gravity.number_zoiul  }, 

{  6,19,  edit_field_fet_iat,  edit_field_put_iiit,  edit_field_key_int,  &spas_P.Gravity.number_zoiuI  }, 

(  7,  5,  edit_field_get_int,  edit_field_put_ist,  edit_field_key_iot,  &orb_P.Gravity.number_tesseral  }, 

{  7,12,  edit_iidd _get_int,  edit_field_put_uit,  edit_field_key_iiit,  dLteiis_P.Gravity.number_tesseral  }, 

(  7,19,  edit_field _gel_int,  edit_fieldj>ut_iiit,  edit_field_k^_int,  &sp«s_P.Gravity.Dumber_tesseral  }, 

{  8,12,  edit_field_get_yesno,  edit_field_put_yesno,  edit_field_key_yesDO,  &tJu»_noise  }, 

{  8,19,  edit_field _get_yesno,  edit_fieldjNit_yesno,  edit_field_key_yesDO,  &spas_noise  }, 

{11,18,  edit_field_get_dbl,  drag_fields_put,  edit_field_key_dbl,  &orb_P.Drag.solar_flux  }, 

{12,23,  edit_field_get_dbl,  drag_fieldsjput,  edit_field_key_dbl,  du>rb_P.Drag.mean_solar_fIux  }. 

{13,34,  edit  fieidjget  dbl,  drag;_fields_put,  edit  field  key  dbl,  &orb  P.Drag.geomegnetic  index_ap 

{18,  9,  edit_field_get_dbl,  init_conds_j>ut,  edit_field_key_dbl,  &Uuis.pos.x  }, 

{18,41,  edit_fteld_get_dbl,  init_conds_put,  edit_field_key_dbl,  &tans.vel.x  }, 

{19,  9,  edit_field_get_dbl,  iiiit_condsj>ut,  edit_field_key_dbl,  ditens.pos.y  }, 

{19,41,  edit_field_get_dbl,  iiiit_conds_put,  edit_field_key_dbl,  &Uns.vel.y  }, 

{20,  9,  edit_^field_get_dbi,  init_conds_put,  edit_field_key_dbl,  &tans.pos.z  j, 

{20,41,  edit_fieldjget_dbl,  iiiit_conds_put,  edit_field_key_dbl,  &tans.vel.z  }, 

{22,25,  edit_field_get_dhinsl,  init_tiine_put,  edit_field_key_dhins,  &tens.tiine  }, 

{24,25,  edit  field_get  int,  edit  field_put  int,  edit  fie!  key  int,  &sim  delay  ms  } 

fdefine  FIELD  l_COUNT  (sizeof(fieldsl)/sizeof(Edit_field)) 

Edit  screen  screen!  « 

{ 

lABELl  COUNT,  labeisl, 

RELDl  COUNT,  fieldsl. 

NULL,  NO,  NULL.  NULL 

h 


♦ - */ 

static  Edit  screen  ^screensQ  « 

{ 

&screeol 

); 

ideEne  MAX_SCREENS  (sizeof(screens)/sizeof(Edit_screen  *)) 
static  int  current  screen; 


int  sim_edit_display_initO 


Bprop,c 


aprop.c 


I 

«dit_fci«en_iiut(scrt«iu{cuncnt_«ci«eii]); 
ratun  YES; 

> 


int  nm  edit  key  bindleKiot  key) 

{ 

int  re  «  edit_sefeea_key_hendler(*ereens{curreal_ecfeen].  k^); 
if  (re  >  0)  return  rc; 

- - 

*1 

switch  (key) 

{ 

case  K£Y_pgup: 

if  (-current  screen  <  0)  currmt  screen  *  MAX  SCREENS  -  1; 
break; 

case  KEY_pgdn: 

if  (+  +curTent_screen  >  *  MAX_SCREENS)  current_8creen  •  0; 
break; 

default:  return  NO; 

} 

edit_screen_itut(screens[current_screen]); 
return  YES; 


/■»» 


*  This  function  is  designed  to  turn  thrust  conutuuids  in  an  LVC  Oocal  LVLH) 

*  coordirute  frame  into  MSO  commanded  delta  v’s  to  be  applied  before  the 

*  next  step  in  the  driver. 

*1 

void  dirust(State_vector  *target,  State^vector  *cbaser, 

VectOT  *deltav  Ivlb,  Vector  *deltav  M50,  Perturbations  *P) 

{ 

double  maflios,  magxxv,  magvbar,  dt,  gcU3][3]; 
double  stq>  «  5.0; 

Vector  ndihat,  vb,  pos_o,  vel_o,  xtxvt; 


/*- 

*/ 


if  (chaser*>time  >  * 

{ 


target- >  time) 


•prop.c 


•prop.o 


pos_o  ■  cliuer->pM: 
vel  o  B  chaser- >vel; 

> 

else 

{ 

dt  B  target- > time  -  diaser->tiine: 

bgprop(chaaer->time,  &chaaer->pos,  &chaaer->vel,  P,  dt,  step,  &pos  o,  &vel  o); 

> 


/* - 

•/ 

magpos  »  vector_ini^tude(&pos_o); 

gcl[0][2]  >  •pos_o.x  /  magpos; 
gcl[l][2]  ■  -pos_o.y  /  magpos: 
gcl[2][2]  «  -pos_o.z  /  magpos; 

/* - 

*/ 

vector_cro8s(&pos_o,  dE.veI_o,  &xtxvt); 
magxxv  s  vector_magnitude(&xtxvt): 

gcl[0][l]  B  mhhat.x  ■  -(xtxvt.x  /  magxxv); 
gcl[l][lj  *  mhhat.y  «  -(xtxvt.y  /  magxxv); 
gcl[2][l]  as  mhhat.z  »  -(xtxvt.z  /  magxxv); 

vector_cross(dipos_o,  &mhhat,  &vb); 

magvbar  *  vector_magnitude(&vb); 

gcl[0][0]  SB  vb.x  /  magvbar; 
gcl[l][0]  «  vb.y  /  magvbar: 
gcl[2K0]  SB  vb.z  /  magvbar; 

vector  traiisform(deluv  Ivlh.deltav  MSO.gcl); 
}  ■ 


*  Hus  is  the  *bad*  fimction.  The  inputs  are  the  target  state  vector,  the 

*  chaser  state  vector,  and  die  time  alloted  for  the  rendezvous  (ttr 

*  diis  must  be  in  even  increments  of  the  propogation  to  allow  for  input  of 

*  the  second  ddta  v).  The  output  is  the  delta  v’s  (in  MSO)  to  be  input  at 

*  the  next  step,  and  at  the  end  of  ttr  for  the  chaser  to  effect  a  rendezvous 

*  with  the  target. 

*/ 

void  rdvz_de]ta_v(State_vector  "target,  State_vector  "chaser, 

douUe  ttr.  Vector  "dvl^^MSO,  Vector  "dv2_M50, 
Perturbations  "P) 


•prop.c 


•prop.c 


{ 

static  double  mu  *  398600.64; 
double  step  »  IS.O; 

double  magposj,  mafvelj,  magxxv,  magvbar.  lcg{3)C3],  8cl[3][3]; 
double  dt,  ddta; 

Vector  xtxvt,  hhat,  vb,  rdot,  ro,  dvl_MS0_l: 

Vector  pos_dif,  dvljvlh,  dv2_lvlh,  omega,  wxr_tenB; 

Vector  pos_t,  vel_t,  pos_o,  vel_o,  pos_tnew,  vel^tnew; 
double  T,w; 
int  ij; 


*  first  match  the  time  tags  by  propogating  target  to  chaser  regardless  of 
which  is  more  recent.  This  is  artificial  due  to  the  restriction  of 

*  applying  delu  v’s  only  at  integrator  (sim)  time  steps  for  chaser. 

*1 

dt  V  chaser->time  •  target->time; 
ifCfabsfdt)  >  l.Oe-8) 

{ 

bgprop(target<  >  time,  duarget- >  pos,  &target->vel,  P,  dt, 
step,  &pos  t,  &vel  t); 

} 

else 

{ 

pos_t  ■  target*>pos; 
vel  t  *  target*  >vel; 

} 

pos_o  chaser*>pos: 
veI_o  *  diaser->vel; 


/-»- 

*/ 


magpos_t  w  vector_magnitude(&pos_t); 
magvd_t  w  vector_magnitude(&vel_t); 

T  w  2*PI*aqrt(niu*mu/(pow(2*mu/magpos  t  •  magvel_t*magvel  t,3))); 
w  -  2*PIfr; 

lcg[l][0]  •  pos_t.x  /  magposj; 
lcg[l][l]  *  posj.y  /  magposj; 
lcg[l][2]  «  posj.z  /  magposj; 

/* - 

•/ 

vector_cross(&posj,&vdJ,  Axtxvt); 
magxxv  m  vector_magnitude(&xtxvt); 


•prop.c 


sprop«e 


lcg[2K0]  »  fahat.x  s  xtxvt.x  /  nxgxxv; 
lcf(2Hl]  *  hhat.y  •  xtxvt.y  /  mgxxv; 
lcgC2][2]  ■  hhat.z  ■>  xtxvt.z  /  magxxv; 

vector_CRMt(ApM_t,  Avb); 

magvbar  «  v«ctor_iiiBgiiitude(divb); 

icgfOKO]  »  vb.x  /  magvbar;  p(M_dif.x  »  pos_o.x  •  po«_t.x; 
lcgIO][l]  «  vb.y  /  magvbar;  pot_dif.y  ■>  pos_o.y  -  pot^t.y; 
lcfI0K21  *  vb.z  /  magvbar;  pos_dif.z  *  pot_o.z  •  pos_t.z: 


vector_tiiiisfonn(&pos_dif,  &ro,  leg); 
/* - 


rdot.x  *  io.x*iiii(w*ttr)  +  ro.y*(6*w*ttr*siii(w*itr)-I4'*(l  -  cos(w*ttr))); 
delta  *  S^Wttr^iinCWttr)  -  -  co8(w*ttr)); 

rdot.x  m  rdot.x/delta; 

rdot.y  *  ro.x+(4'*tdot.x-6*ro.y)*iin(w*ttr)+(6*ro.y-3*rdot.x)'*w*ttr; 
rdot.y  «  fdot.y/(-2)/(I-cos(w'*ttr)); 
rdot.x  «  rdot.x*w; 
rdot.y  ■  rdot.y*w; 

rdot.z  -ro.z*w/tan(w*ttr); 

omega.  X  »  o.O; 
oinega.y  «  0.0; 
oinega.z  s  w; 

vector_cross(&omega,  &ro,  &wxr_teiin); 


dvljvlh.x  ■  rdot.x  +  wxr_tenn.x; 
dvljvlh.y  “  rdot.y  +  wxr_tenn.y; 
dvljvlh.z  B  rdot.z  4-  wxr_tenn.z; 

lbr(j«0;  j<3;  j++) 

{ 

ft)r(i«0;  i<3;  i++) 

{ 

gcUilGl  -  IcgGini; 

} 

) 

vector_traiufonii(&dvl_lvUi,  dulv)_MS0_,l,  gel); 


•pr^.c 


mprop.e 


dvl_M50->x  «  vel_t.x  +  dvl_M50_l.x  -  vel_o.x; 
dvl_M50->y  ■  vel_l.y  +  dvl_M50_l.y  •  vel_o.y; 
dvl_M50->x  vel_t.x  +  dvI_M50_I.2  -  veI_o.z; 

/* - 

•/ 

dv2Jvlh.x  ■  (2*fdol.y*iin(w*ttr)+(4*fdo*.x-6*w‘*ro.y)*coi(w*itr)+ 
6*w*ro.y-3*Tdoc.  x): 

dv2jvlh.y  «  ((3*w*ro,y  -  2*'rdot.x)^ui(w*ttr)  +  fdot.y*cos(w*ttr)); 
dv2_lvlh.z  »  rdot.z'''oos(w*ttr)  -  ro.x*w*Mn(w*ttr); 


/* 

*  next  we  have  to  propogate  the  target  again  to  a  time  ttr  plus  where  we 
we  are  right  now  (a  second  propagation) 

*/ 


/* - 

*1 

bgprop(chaser->time,  &pos_t,  &vei_t,  P,  ttr,  step,  &pos_tnew,  &vel_tnew); 

magpos^^t  s  vector_inagnitude(&pos_tnew); 

gcl[0][l]  *  pos_tnew.x  /  magposj; 
gcl[l][lj  »  pos_tnew.y  /  magpos^t; 
gcl[2][l]  «  pos_tnew.z  /  magposj; 

/* - 

*/ 

vector_cross(&pos_tnew,  &vel_tnew,  &xtxvt); 
magxxv  m  vector_niagnitude(du(txvt); 

gcl[0][2]  «  hhat.x  «  xtxvt.x  /  magxxv; 
gcl[l][2]  B  hhat.y  »  xtxvt.y  /  magxxv; 
gcl[2](2]  »  hhat.z  «  xtxvt.z  /  magxxv; 

vector_cross(&pos_tnew,  &hhat,  &vb); 

magvbar  »  vector_magnihide(&vb); 

gcl[0][0]  X  vb.x  /  magvbar; 
tcl[l][0]  X  vb.y  /  magvbar; 
fcl[2K0]  X  vb.z  /  magvbar; 

vector_tranfform(&dv2Jv]h,dv2_MS0,gcl); 


> 


•prop.c 


•prop.e 


*  t*^u**(N***<•  *orbil«r)...prodiice«  a  quatemiaa  for  the  attitude  of  the 

*  orbitw  'Obi'  baaed  on  its  positioo  and  velocity.  This  is  by  no  means 

*  u  impUcatioo  that  this  propogates  the  orbiter  attitude.  This  is  however 

*  a  way  of  creating  a  time  varying  quatemian  baaed  on  a  desired  attitude. 

*  diis  fonction  is  currently  designed  to  produce  a  gravity  gradient  position 

*  with  the  payload  bay  focing  aft,  as  if  preparing  to  rendezvous. 

*  - - - - .*/ 

void  getquat(vmd) 

{ 

Vector  pos_o,  veI_o,  bl,  b2,  b3,  rtv,  b]xb2: 
double  A,  B,  C,  magpos,  magrxv,  magblxb2; 
int  good_quat,  i; 

pos_o  *  tans.pos; 
vel_o  *  tans.vel; 

/• - 

*/ 

magpos  «  vector_magnitude(d(pos_o); 
bl.x  «  pos_o.x/magpos; 
bl.y  K  pos_o.y/ttuigpos; 
bl.z  pos_o.z/iiiagpos; 

vector_cross(&pos_o,&vel_o.&rxv); 
magrxv  »  vector_inagnitude(&rxv); 
b2.x  »  -rxv.x/magrxv; 
b2.y  »  -rxv.y/magrxv; 
b2.z  «  -rxv.z/tmgrxv; 

vector_cross(&bl  ,&b2,&blxb2); 
nuigblxb2  «  vector_magnitude(&blxb2); 
b3.x  B  blxb2.x/tnagblxb2; 
b3.y  «  blxb2.y/niagblxb2; 
b3.z  B  blxb2.z/inagblxb2; 

/* - 

•/ 

A  «  bl.y  +  b2.x; 

B  •  b2.z  +  b3.y; 

C  ■  bl.z  +  b3.x; 

if(fobs(B)  >>  l.Oe^) 

orb_quat.x  •  sqrt(A*C/4.0/B); 
if(  fti^otb  quat.x)  >  >  l.Oe-8  ) 

{ 

orb_quat.y  A/4.0/orb^quat.x; 
orb^quat.z  *  C/4.0/orb_quat.x; 
if(  fibs(orb  quat.y)  >«  i.Oe-8  ) 

{ 


•prop<c 


•prop.e 


orb  quat.t  «  (bl.z  -  2*orb  qiut.x*orb  quat.z)/2/orb  quat.y; 

}  ■ 

else 

{ 

orbjquat.y  ■>  orb_quat.z  *  0.0; 
orb  quat.s  *  orb  qiuU.x  •  0.7071; 

} 

> 

else 

{ 

orb_qiiat.y  »  orb_qittt.z  «  0.0; 
orb  quat.s  »  orb  quat.x  *  0.7071; 

\ 

> 

else 

{ 

orb_quat.y  «  orb_quat.z  «  0.0; 
orb  quat.s  «  orb  quat.x  »  0.7071; 

} 

/* - 

*! 

good_quat  »  NO; 
orb_quat.x  «  -orb_quat.x; 
i  ■  0; 

while  (good  quat  s  =  NO) 

{ 

orb_quat.x  >  •orb_quat.x: 
good_quat  »  testquat(&bl,&b2,&b3); 

i++T 

if(i  >  2) 

{ 

orb_quat.y  »  orb_quat.z  »  0.0; 
orb_quat.s  “  orb_quat.x  »  0.7071; 
good  quat  «  YES; 

} 

} 

orb_quat.tiioe  *  tans.time; 

> 


*  This  function  evaluates  the  valitity  of  the  relatitmship  between  a 

*  quaternion  and  a  DCM  conqwsed  of  three  ortlKMionna]  vectors  as  the  rows 

*  - */ 


int  testquat(Vector  •bl,  Vector  ♦b2,  Vector  *b3) 

{ 

doiritle  dif; 
int  good_quat; 


•prop.c 


•prop.e 


dif  ■  fcbi(bl->y  -  2*(ofb_qu«t.x*orb_qu«t.y-orb_qual.t*orb_qua!.2)); 
dif  ■  dif  +  fii*i(bl->z  -  2‘'<orb_qu«t.x'*tort»_qu«.*+ofb_qu«l.t*orb_qu*l.y)); 
dif  «  dif  +  fabt(b2->x  -  2*(orb_qiutf.x‘N>rb_quat.y+ort»_quat.i*ofb_qiMtt.z)); 
dif  »  dif  +  firi)«(b3->x  -  2*(orb_qu«t.x*orb_quzt.z-orb_qiutf.»*orb_qiiat.y)); 
dif  ■  dif  -f  fabs(h3->y  -  2*(orb_qiutt.y*orb_quat.z+ort)_qiiit.«*ofb_quat.x)); 
dif  «  dif  +  fcb«^->z  -  2*(orb_quat.y*orb_qu«t.z-orb_qiial.s*ofb_quat.x)); 

ifCdif  <  I.e-6) 

{ 

good  quat  *  YES; 

} 

else 

{ 

good  quat  »  NO; 

} 

fetum(good_quat); 


aprop.c 


•propdtfk.c 


l^lude  <itdio.h> 
^loclude  <ftdlib.b> 
(Knclude  <iii8th.b> 

iKnclude  <edit.h> 
miiiclude  <edit_rt.h> 
^include  <k^s.b> 
#incliKie  "•im.h* 

/^SKSsSKsmsa 


Static  State_vector  tans,  spas,  orb_ins,  noisy_tans,  hold_tans: 
static  Quaternion  orb_quat; 

static  double  tans_delta_t,  tans_step; 
static  double  spas_delta_t.  spas_step: 
static  double  orb_ins_delta_t,  orb_ins_step: 
static  double  rx_variance,  vx_variance; 
static  double  fy_variance,  vy_variance; 
static  double  rz_varianee,  vz_variance; 

static  Perturbations  fir  tans_P,  fu’  orb_P,  far  spas_P; 

static  double  impulse  *  2.0'*0.00003048,  tiine_to_mdv,  dv2_time; 
static  Vector  delta_v2; 

static  int  mdv_in_progress,  noise,  tans_running  »  YES; 


* - *! 

static  void 

thrust(State_vector  *,  State_vector  *,  Vector  *,  Vector  *,  Perturbations  *), 
rdvz_delu_v(State_vector  ♦,  State_vector  *,  double.  Vector  Vector  *,  Perturbations  *), 
getquat(void); 

static  int 

testquat(Vector  ♦,  Vector  Vector  *); 
static  HLE  ■*infUe2; 

/*«  sssvsassssssBSSssaiBKzassssssBsssssaEBaESssssssss 


Mefine  Julian  date  2000  245154S.0 

* - •/ 

int  aim  initO 

{ 


•propdsk.c 


•propdflk.e 


char  *fileiiaine2; 


fiieiiaiDe2  •  edit_text(''Eater  ioput  fileaanie:*.  'taas_sa.ilat*): 
if  ((mfile2»fopen(fileiiaiDe2,  "r'))  ••  NULL) 

{ 

printfCCaa’t  open  %s\d*,  fileiiaiiiel); 
retuni  NO; 

) 


/* - 

*/ 

tans-time  -  ((((20  *  24)  +  2)  60.0)  +  15)  60.0  +  0.0; 
tans.pos.x  »  6600.0;  tans.pos.y  «  0.0;  tans.pot.z  »  0.0; 

tans.vel.x  ■  0.0; 

tans.vel.y  «  sqit(3.9860064e-fS/vector_magnitude(&UB$.pos))-f0.0; 

tans.vel.z  •  0.0; 

tans_delta_t  *  10.0;  Uns_step  «  10;  /*  step  size  (sec)  *! 

timejo_fndv  »  tans_^deltaj‘^double)((inl)(4020.0/tans_delta_t)); 


*/ 

spas.lime  *  ((((20  *  24)  +  2)  *  60.0)  +  15)  *  60.0  +  0.0; 
spas.pos.x  *  66(X).0;  spas.pos.y  «  0.0;  spas.pos.z  =  0.0; 

spas.vel.x  s  0.0; 

spas.vel.y  «  s()rt(3.986(X)64e4-5/vector_inagnitude(&spas.pos)); 

spas.vel.z  »  0.0; 

spas_delta_t  »  4S.0;  spas_step  s  10; 

I* - 

*/ 

orb_ins.tiiDe  =  ((((20  ♦  24)  +  2)  *  60.0)  +  15)  60.0  +  0.0; 
ofb_iiu.pos.x  »  6600.0;  orb_iiis.pos.y  *  0.0;  orb_iiis.pos.z  ^  O.O; 

orb_ins.vel.x  «  0.0; 

orb_iiis.vel.y  •>  sqit(3.986(X)64e-t-5/vector_niagnitude(&taos.pos))+0.0; 
orb_ins.veI.z  ■*  0.0; 

oib_ins_delta_t  «  10.0;  orb_ins_step  «  10;  /*  step  size  (sec)  */ 


I* - 

*/ 

laas_P.  Drag,  mode 


■propdak.c 


apropdsk.c 


orb_P.  Drag,  mode  «« 
qMS_P. Drag. mode  «  ON; 

tans_P.Drag.eol«r_fltix  « 
orb  P.Dng.foUr  flux  ■> 

•|»s_P.Drag.eoIar_flux  «  18S.9S93403793603; 

Uns_P.Drag.meu_toIer_flux  * 
orb_P.Dnig.mean_soIar_flux  • 
■pas_P.Dng.mean_solai^flux  ■  178.6447698684861; 

tans_P.Dng.geomagne(ic_index_«p  * 
orb_P.Drag.geonuignetic_iiidex_ap  >■ 
s|MS_P.Drag.geoinegnetic_index_ep  *  19.87811961456716; 

Uns_P.Drag.baIIistic_number  *  64.0; 
orb_P.Drag.be]Iiitic_number  »  64.0; 
•pas_P.Drag.ballistic_number  •  64.0; 

tans_P.Gravity.number_zoiuI  * 
orb_P.Gravity.number_zoiMl  « 
q»s_P.Gravity.number_zoiud  «  6; 

tens_P.Gravity.oumber_teMefmI  » 
orb_P.Gravity.number_leuefml  » 
ipu_P.Gravity.aumber_tessend  «  6; 

insUntiate _gotpot(l,  dcUns_P); 
iniuntiate _gotpot(l,  diorb_P); 
instantiate _gotpot(l,  dcspas_P); 

if  (bgprop_initO  *  »  NO)  return  NO; 

/* - 

*/ 

tpUfuiO; 
return  YES; 

} 


/* 


♦ - */ 

void  aim  stopO 

{ 

} 

f*mmmmmmmmmmmmmmmmmmmmmmmmmmmmmm 


*. 


*/ 
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int  nm  next  tampleCSim  mnple  ^sample) 


•Utic  double  initi«l_time; 
static  first_tiiDe  YES; 

int  cat; 

/* - - - 

*/ 

if  (mdv  in_progrets  &A  tans.time  >  «  dv2  time) 

{ 

tans.vel.x  delu_v2.x; 

tans.vel.y  -*  delu_v2.y; 
tans.vel.z  deita_v2.z; 

orb_ins.vel.x  -»  de]ta_v2.x; 
orb_ins.vel.y  -«  delta_v2.y; 
orb_ins.vel.z  -=  delta_v2.z; 
mdv  injirogfess  *  NO; 

} 


/* - 

*/ 

cnt  «  fscanf(infile2,*%lf  %if  %tf  %lf  %lf  %lf  %if,  &sanq>le*>orb _gps.time, 
duample->orb_gps.pos.x,  &saffiple->orb_gp$.po$.y,  &swiiple->orfo_gps.pos.z, 
disample>>orb _gps.vel.x,  &sample->orb _gps.vel.y,  &sanq>ie->orb_gps.veI.z); 

if  (cnt  <  7)  return  NO; 

if  (first  time) 

{  ' 

initial^time  —  sample- >  spas,  time; 
firstjime  =  NO; 


sample- >otb_gps.  time  -f  »  initial_time; 

/♦ - 

*/ 

if  (spas.time  -f  spu  delta_t  <  *  orb  ins.time  -f  orb  ins  delta  t) 

{ 

bgprop(spas.time,  &spas.pos,4cspas.vel,  &spu_P,spas_delta_t,spas_step,  &spas.pos,&spas.vel); 
spas.time  -t-*  q)as_delta_t; 


/* - 

*/ 

bgpn>p(orb__ins.time,  &0(b_ins.pos.  &ofb_ins.vel, 
4torb_P,orb_ins_delu_t,orb_ins_step,  &orb_ins.pos,&orb_ins.vel); 
orb_ins.time  -f  »  orb_ins_delta_t; 
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/* - 

*1 

if  (noise) 

{ 

rx_vsruuice  ■  pow((doubIeXnuidoin(IOOO)-SOO)/SOO.O.  3.0)  *  .2; 
fy_vafMiice  »  pow((doubIeXnuMk>ni(l(n0)-S00)/500.0.  3.0)  *  .2; 
n_variance  •  pow((<loubleXnuidoin(1000)-S00)/S00.0,  3.0)  *  .2; 
vx_varMiice  »  po«'((dcHibleXniKioiii(1000)-S00)/S00.0,  3.0)  *  .001 
vy_vsri«Dce  •  pow((doubleXnndoni(1000)-S00)/S00.0,  3.0)  *  .001 
vz  vsritoce  «  pow((doubleXnndoin(1000)-500)/500.0.  3.0)  *  .001 

} 

else 

{ 

rx_vsrisnce  »  0.0; 
iy_vtrMuice  =  0.0; 
rz_vsrisnce  =  0.0; 
vx_vsrisnce  ^  0.0; 
vy_vtrisnce  =  0.0; 
vz  vsrisnce  «  0.0; 

) 

noisy^tsns.pos.x  »  rx_vsrisnce  +  tsns.pos.x; 
aoi^_tsns.pos.y  iy_vsrisnce  +  tsns.pos.y; 
noi^_tsns.pos.z  «  rz_vsrisnce  4-  tsns.pos.z; 

noisy _tsns.vel.x  »  vx_varisnce  ums.vel.x; 
noiay_tsns.vel.y  *  vy_vsrisnce  +  Cans.vel.y; 
noi^_tans.vei.z  b  vz_variance  4-  tsns.vel.z; 

noi^_Uns.tiine  »  tans.time; 


if  (tsns_nuuiing  — »  YES)  hoId_uns  s  noisy_uns; 

/* - 

♦/ 

sample- >q)as_sv  «  ^tas; 
saniple->spas jps  *  spas; 
aaflq>le->c^_taig  ^  qns; 
saiqrie->Ofb_ins  ae  orb^ins; 
san4>le->Ofb_quat  at  orb_quat; 
sample- >orb_gps  hold^tans; 
letum  YES; 


int  sim  liandier(int  k^) 

( 
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//  static  cbar  work[32]; 

Vector  ddtavjvlh,  deItav_M50,  delta_vl; 
int  Bew_mdv_fUig  »  NO; 

/*• . . . . . . 

*/ 

■witch  (key) 

{ 

cate  ICEY_alt_fl: 

orb  ins  *  tans;  //ofb_iBs  update 

break; 

case  KEY_aIt_f2:  “>***« 

noise  s  (noise  ?  NO  :  YES); 
break; 

case  KEY_alt_0:  //TANS  running  toggle 

tans  running  ^  (tans_running  ?  NO  :  YES); 
break; 

case  KEY_alt_f5:  //positive  ’v’ 

deltav3'Ui.x  *  impulse;  dellavjvih.y  *  0.0;  dellavjvih.z  »  0.0; 
dirust(&spas,  Atans,  &deltav_Ivlh,  dkdeltav^MSO,  &tans_P); 
taas.ve}.x  +*  deltav_M50.x; 
tans.vel.y  +»  deltav_M50.y; 
tans.vel.z  «  deltav_M50.z; 
orb_ins.vel.x  +«  deltav^MSO.x; 
orb  ins.vel.y  +  *  deItav_M50.y; 
orb  ins.vel.z  +•  deltav_M50.2; 
bre^; 

case  KEY_alt_f6:  //negative  ’v’ 

deltav  Ivi^x  »  -impulse;  deltavjvlb.y  »  0.0;  deltavjvlh.z  «  0.0; 

tlmist(&spas,  &tans,  dcdeltavjvlh.  dledeluv_M50.  &taos_P); 

tans.vel.x  +■  deltav_M50.x; 

tans.vel.y  -f*  deltav_M50.y; 

tans.vel.z  4-«  deltav_M50.z; 

orb_ins.veI.x  +•  deItav_M50.x; 

otb_ins.vel.y  +■  deltav__M50.y; 

orb  ins.vel.z  »  deltav__M50.z; 

breiA; 

case  KEY  alt  f7:  //positive  ’r’ 

deltevjvlkx  ■  0.0;  deltovjvlh.y  ■  0.0;  deluvjvlh.z  ■  i^^>ulse; 

dinist(&spas,  Atans,  &deltav_)vUi,  &deItav_M50,  &tans_P); 

tans.vel.x  +»  deItav_M50.x; 

tans.vel.y  «  deluv_M50.y; 

tans.vel.z  deltav_M50.z; 

otb_ins.veI.x  +*  deltav_M50.x; 
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orb_iiu.vei.y  -f  «  delUv_MSO.y; 
orb_,ins.vel.z  +■  delUv_M50.z; 
break; 

eaae  KEY_alt_f8:  //nefative  'r’ 

deltavjvlh.x  «  0.0;  deluvjvlh.y  *  0.0;  deluvjvlh.z  •  MiiqMiiae; 
dinist(&spas,  Ataiu,  Adeltavjvlh,  4uieltav_MS0,  4ctani_P); 
taDi.veI.x  -fa  delUv_MS0.x; 
tans.vel.y  deltav_M50.y; 
taiu.vel.z  -fa  deltav_MS0.z; 
orb_iiu.vel.x  4- »  deltav_M50.x; 
orb_iiu.veI.y  +■  delUv_MS0.y; 
orb^ins.vel.z  •f  >  deltav_MS0.z; 
break; 

case  KEY_aIt_f9:  //increase  ’delu  v’ 

impulse  -t-s  0.00003048; 

//  setoolor(0); 

//  outtextxy(80,80,  work); 

//  sprintfCwork.'ftb.ir,  iinpuIse/0.0003048); 

//  tetcolor(7); 

//  outtextxy(80,80.  work); 
break; 

case  KEY_alt_fl0:  //decrease  ’delta  v’ 

impulse  0.00003048; 

//  aetcolor(0); 

//  outtextxy(80,80,  work); 

//  sprintf(work,''%6.2r,  impulse/0.0003048); 

//  setcolor(7); 

//  outtextxy(80,80,  work); 
break; 

case  KEY_alt_r:  //secret  stuff 

rdvz_delta_v(&spas,  &tans,  time_to_tDdv,  &delta_vl,  &delta_v2,  &tans_P); 

tans.vel.x  +•  Mu_vl.x; 

tans.vel.y  -f  «  delu_vl.y; 

tans.vel.z  +•  delta_vl.z; 

orb_ins.vel.x  +>  delta_vl.x; 

orb_ins.vel.y  +*  delta_vl.y; 

orb_ins.veI.z  -f  <■  delta_vl.z; 

dv2_time  «  lans.time  +  time_to_mdv; 

new  mdv  flag  «  YES; 

break; 


defnilt: 

new_mdv_flag  *  mdv_in_progress; 
break; 
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n>dv_iB_progrw  ■■  Bew_fDdv_flag; 
raoini  YES; 

> 


*  Tbeie  are  helper  routines  for  the  edit  screens  below.  These  routines  hdp 

*  by  copying  one  just-set  variable  to  others  that  must  be  the  same  value. 

*  - •/ 

static  int  dng_fieids_put(char  *Mvork.  void  *riau) 

{ 

edit_field_put_dbl(work,  data); 

if  (data  gEorb_P.Drag.aoiar_fIux) 
tans_P.Drag.s(dar_flux  « 
spas_P.Dnig.aoiar_flux  «  orb_P.Dref.solar_flttx; 
else  if  (data  *  »  &orb_P.Drag.mean_solar_fIux) 
tans_P.I>rag.mean_solar_flux  * 

q)as_P.Drag.mean_solar_fIux  *  orb_P.Drag.mean_solar_flux: 

else 

tans_P.Drag.geomagnetic_index_ap  * 

spas_P.Drag.geomagnetic_index_ap  orb_P.Drag.geomagnetic_index_ap; 
return  YES; 

I 

static  int  orb  ballistic_put(char  'Voifc,  void  '"dau) 

{ 

edit_fieid_put_dbl(worfc,  data); 

tans_P.Drag.bal)istic_number  «  orb_P.I>nig.baliistic_number; 
return  YES; 

} 
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•tatic  Edit  label  labelalQ  » 

{ 

{  1,20,  *S1M  ProfMgatioii  Peiturbatioas*), 

{  3,  3,  'Oib  TANS  SPAS"}, 

{  4,24,  'Drag  mode  on”}, 

{  5,24,  'Ballistic  number'}, 

{  6,24,  'Zonal  harmonic'}, 

{  7,24,  Tesaeral  bannonic'}, 

{  8,24,  'Noise  nwde  on'}, 

{10,  4,  'Drag  Infonnation'}, 

{11,  6,  'Solar  Flux;'}, 

{12,  6,  'Mean  Solar  Flux:'}, 

{13,  6,  'Geomagnetic  Activity  Index:'} 

}; 

Mefine  LABELl_COUNT  (si2eof(labelsl)/si2eof(Edit_iabel)) 

static  Edit  field  fieldslQ  * 

{ 

{  4,  S,  edit_field jget _yesno,  edit_fieldjput_yeano,  edit_fieId_k^_yeano,  &orb_P.Drag.mode  }, 

{  4,12,  edit_field _get _yesno,  edit_field_put_ycsno,  edit_field_k^_yesno,  &tans_P.Drag.mode  }, 

{  4,19,  edit_field _get_yesno,  edit_field_put_yeaao,  edit_field_k^_yesao,  &apas_P.Drag.mode  }, 

{  S,  8,  edit_field _get_dbl,  orb^Mlisticjput,  edit_fidd_k^_dbl,  du>rb_kDiag.ballistic_nun^r  }, 

{  5,18,  edit_field_get_dbl,  edir,fieldjput_dbl,  edit^field__kqr_dbl,  4kspas_P.Drag.ballistic_number  }, 

{  6,  5,  edit_field _get_int,  edit_fieldj>ut_int,  edit_field_key_int,  &ofb_P.Gnvity.nuniber_zonal  }, 

{ 6,12,  edit_field _get_int,  edit_fieldjput_int,  edit_field_k^_mt,  4ttans_P.Gnivity.number_zooal  }, 
{6,19,  edit_field _get_int,  edit_fieldjput_int,  edit_field_k^_int,  Aspas_P.Gravity.number_zonal  }, 

{  7,  5,  edit_field _get_int,  edit_fieldjNit_int,  edit_field_kqr_int,  &oA_P.Gnivity.number_tesseral  }, 

{  7,12,  edit_field _get_int,  edit_field_jHit_int,  edit_fteld_kq^_int,  &tans_P.Gravi^.number_tesserBl  }, 

{  7,19,  edit_field_get_int,  edit_fieldjMit_int,  edit_fidd_kqr_iot,  dupas_P.Gravity.number_tesseral  }, 

{  8,12,  edit^field _get _yesno,  edit_fieldjNit_yesoo,  ^it_field_k^ jresno,  dcMise  }, 

{11,18,  edit_field_fet_dbl,  drag^fieldsjNit,  edit_field_k^_dU,  &ofb_P.D^.solar_flux  }, 

{12,23,  edit_field _get_dbl,  drBg_fieldsjHit,  edit_field_key_dbl,  &oib_P.DrBg.mean_solar_flux  }, 

{13,34,  edit  field _gtl  dbl,  drag  fields_put,  edit  field  kty  dbl,  &orb_P.Drag.geomagnetic  index  ap 

}  -  --  __ 

>; 

idefine  FIELD1_C0UNT  (sizeof(fieldsl)/sizeof(Edit_field)) 

Edit  screen  sereenl  * 

{ 

LABELl_COUNT,  labelsl, 

FIELDl  COUNT,  fieldsl 

>; 


I* 


static  Edit  screen  *sereensQ  ■■ 
{ 

Asereenl 
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}: 

Meffoe  MAX_SC3(EENS  (•ueof(icf«eiis)/sixeof(Edit_tcf«en  *)) 


iat  liia  «dit  diqibQf  iaitO 

edit_Kma_iBit(tef«eai(curf«at_ienea]): 
fetun  YES; 

} 


/' 


* - - - */ 

iat  siai  edit  kty  luuidler(iat  k^) 

{ 

iat  rc  »  edit_wraea_k^_liaadler(screeas[cuneat_Kf«ea],  key); 
if  (rc  >  0)  return  rc; 

/• - 

*/ 

twitch  (kqr) 

{ 

case  KEY_pgup: 

if  (-currcat  screen  <  0)  current  screm  «  MAX  SCREENS  •  1; 
break; 

case  KEY_pgdn: 

if  (<f  ■feurreat_screen  >■  MAX_SCREENS)  current_screen  «  0; 
break; 

defiuiit:  return  NO; 

} 

edit_screea_iait(acreeaa[curreat_screea]); 
return  YES; 

) 


*  This  Auction  it  desifned  to  turn  thrust  in  an  LVC  Ooca)  LVLH) 

*  coordinate  Anme  into  M50  comnautded  delta  v’s  to  be  applied  beA>re  the 

*  next  step  in  the  driver. 

*/ 


void  thrust(State_vector  *tarfet,  State_vector  *chaaer, 

Vec^  *deltavjvlh,  Vectw  ^tav_MS0,  Perturbations  *P) 
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fiaclude  <Btdio.h> 
iinclude  <aUoc.h> 

finclude  <edit.b> 
fiaclude  "nm.!!* 


fdefiae  MAX_SAMPLES  (Oxffff  /  •i2eof(SiiD_saa>pIe)  •  1) 
typedef  stnict  _a)em_buffer 


stnict  _meni_buffer  *next: 
int  count; 

Sini_sainple  aeinples[MAX_SAMPLES]; 
}  Mem_buffo; 


flUtic  Mein_buffer  *buffer_first,  *bufrer_cuiTeot: 
•letic  Sini_Hunple  *ieinple_next; 

•tetk  iat  Mniple^cat; 


iat  lin  iaitQ 

{ 

cbar  ^leaanie; 
HLE  *iafile: 


iat  sanities; 


Men_buf!er  *bufrer.  *bufrer_prev; 


/* - 

*/ 

fileaame  ■  edit_text(*Eater  iiqHtt  fUeaune:'',  *sim.dat”); 


if  ((iafile»fopea(filename,  ”ib*))  NULL) 

( 

priatf(*Caa’t  open  KsVa",  fileaame); 
ntura  NO; 

} 


/• - 

*/ 

teek(iafile.  OL,  SEEK  END); 


e 


■unplM  »  (iBtKftell(uifile)  /  auaof(SiiB_nfiiple)); 

nnpies  «  edit^inti^erf'How  nmay  m^lM  should  1  load:*.  saii4>lcs); 

if  (ssiB^as  <  «  0) 

{ 

fcloseOnfllc); 
ntum  NO; 

) 

tookCaifiie.  OL,  SEEK.SED: 

/* - - 

*/ 

for  (bttffer^prev  m  NULL; 
sunplos  >  0; 

samples  MAX  SAMPLES.  buffer_prev  m  buffer) 

{ 

if  ((buffer  at  iiialioc(sixeof(Meffl  buffer)))  « «  NULL) 

{ 

priatfCRan  out  of  memofy,  5fd  saii4)les  remaiiiingNii''.  samples); 

fclose(infi)e); 

return  NO; 

) 

if  (buffer_,first  ■  •  NULL)  buffer_fir8i  »  buffer; 
else  bufferj>rev->next  «  buffer; 

buffer->next  *  NULL; 

buffer- >  count  •  firead(buffer->  samples,  sizeof(Sim_saniple),  MAX_SAMPLES,  infile); 
if  (buffer- >  count  <»  0)  samples  «  0; 


f* - 

♦/ 

buffer_current  m  buffer_fifst; 
sam^e_ait  at  buffer_curreot->  count; 
aampie_Dext  buffer_cuiTent->  samples; 

fc)oae(infi)e); 
return  YES; 


- - */ 

void  ra_stop0  {  } 


*. 


■*/ 


c 
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{ 

double  magpos,  magxxv,  magvbar,  dt,  |^1[3][3]; 
double  step  s  S.O; 

Vector  mhhat,  vb,  pos_o,  vel_o,  xtxvt; 


/* - 

*1 

if(  cha8er->tioie  >»  taiYet->time  ) 

{ 

pos_o  —  chaser*  >pos; 
vel  o  «  chaser*>vd; 

} 

else 

{ 

dt  =  target- >  time  -  chaser- >  time; 

bgprop(chaser->time,  &chaser->pos,  &chaser->vel.  P,  dt, 
step,  &pos  o,  &vel  o); 

> 

/■* - 

*/ 

magpos  =  vector_iiiagiiitude(&pos_o); 

gcl[0][2]  =  -pos_o.x  /  magpos; 
gcl[l][2]  =  -pos_o.y  /  magpos; 
gcl[2][2]  =  •pos_o.z  /  magpos; 

/* - 

*/ 

vector_cross(d4>os_o,  &vel_o,  &xtxvt); 
magxxv  —  vector_magiutude(&xtxvt); 

gcl[0][l]  s  mhhat.x  »  -(  xtxvt.x  /  magxxv); 
gcl[l][l]  —  mhhat.y  =  ^  xtxvt.y  /  magxxv); 
gcl[2][l]  —  mhhat.z  =  -(  xtxvt.z  /  magxxv); 

vector_cross(d^>os_o,  &mhhat,  &vb); 

magvbar  =  vector_magnitude(&vb); 

gc)[0][0]  s  vb.x  /  magvbar; 
gcl[I][0]  s  vb.y  /  magvbar; 
gcl[2][0]  s  vb.z  /  magvbar, 

vector  tnmsform(deltav_lvlh,deltav_MSO,gcl); 

} 


*  This  is  the  "bad*  fiinction.  The  inputs  are  the  target  state  vector,  the 
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*  chaaer  state  vector,  and  tbe  time  alloted  for  the  rendezvous  (ttr 

*  this  must  be  in  even  increments  of  tbe  propogation  to  allow  for  input  of 
'*  tbe  second  delta  v).  The  output  is  tbe  delta  v’s  (in  M50)  to  be  input  at 

*  the  next  stq>,  and  at  tbe  end  of  ttr  for  die  chaser  to  effect  a  rendezvous 

*  with  the  target. 

*/ 

void  rdvz_delta_v(State_vector  ^target,  State_vector  ^chaser, 

double  ttr,  Vector  'Mvl_MSO,  Vector  '*dv2_MS0, 
Perturbations  *P) 

{ 

static  double  mu  s  398600.64; 
double  step  «  15.0; 

double  magpos_t,  magvel_t,  magxxv,  magvbar,  lcg[3][3],  gcl[3][3]; 
double  dt,  delta; 

Vector  xtxvt,  hhat,  vb,  rdot,  ro.  dvl_M50_l; 

Vector  pos_dif,  dvl_lvlh,  dv2_lvlh,  omega,  wxr_term; 

Vector  pos_t,  vel_t,  pos_o,  vel_o,  pos_tnew,  vel_tnew; 
double  T,w; 
int  ij; 


/* 

*  first  match  the  time  tags  by  propogating  target  to  chaser  regardless  of 

*  which  is  more  recent.  This  is  artificial  due  to  the  restriction  of 

*  ayqiiying  delta  v’s  only  at  integrator  (sim)  time  steps  for  chaser. 

•/ 

dt  cbaser*>time  •  target->time; 
if(fsbs(dt)  >  l.Oe-8) 

{ 

bgprop(target->time,  &taiget->pos,  &target->vel,  P,  dt, 
step,  &pos  t,  &vel_t); 

} 

else 

{ 

pos_t  =  target'>pos; 
vel_t  =  target*  >vel; 

} 

pos_o  «  chaser->pos; 
vel_o  »  chaser- >vd; 


/♦ - 

*/ 

magpos_t  s  vector_magnitude(d4K>s_t); 
magvel_t  »  vector_magnitude(&vel_t); 

T  *  2‘*n''’sqrt(mu'''nHi/(pow(2''1iHi/magpos_t  -  magvel_t*magvel_t,3))); 
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w  »  2*H/T; 

lcg[l][0]  K  pos_t.x  /  iiHigpos_t; 
lcg[l][l]  B  pos_t.y  /  iiHigKM_t; 
lcg[I][2]  s  pos_t.z  /  iiuigpos_t; 

/* - 

*/ 

vector_cross(&pos_t,&vel_t,  &xtxvt): 
magxxv  s  vector_ii»giutude(&xtxvt); 

lcg[2][0]  s  hlua.x  s  xtxvt.x  /  nuigxxv; 
lcg[2][l]  s  hhat.y  «  xtxvt.y  /  magxxv; 
lcg[2][2]  =  hhat.z  »  xtxvt.z  /  magxxv; 

vector_cross(&pos_t,  &hhat,  &vb); 

magvbar  «  vector_aiagnitude(&vb); 

lcg[0][0)  as  vb.x  /  magvbar;  pos_dif.x  *  pos_o.x  -  pos_t.x; 

lcg[0][l]  as  vb/'  /  magvbar;  pos_clif.y  =  pos_o.y  -  pos_t.y; 

lcg[0][2]  as  vb.z  /  magvbar;  pos_dif.z  -  pos_o.z  -  pos_l.z; 


vector_tiaiiaform(&pos_dif,  &ro,  leg); 

/* - 

f/ 


rdot.x  =  ro.x'*^m(w''‘ttr)  +  ro.y*(6*w*ttr*sm(w*ttr)-14'''(l  -  cos{w*ttr))); 
delta  =  3*W^r*''sm(w*ttr)  -  8*(1  -  cos(w''‘ttr)); 
rdot.x  s  rdot.x/delta; 

rdot.y  ro.x+(4*rdot.x-6''^.y)*8in(w*ttr)+(6*ro.y-3'*^ot.x)*w*ttr; 
rdot.y  »  rdot.y/(-2)/(I-cos(w*ttr)); 
rdot.x  a«  rdot.x*w; 
rdot.y  =  rd(rt.y*w; 

rdot.z  S'  -ro.z*w/tan(w*ttr); 

om^.x  as  0.0; 
omega.y  as  0.0; 
oiiiega.z  s  w; 

vector_cross(&omega,  &io,  &wxr_term); 


dvljvlh.x  as  rdot.x  +  wxr_term.x; 
dvljvlh.y  a*  rdot.y  wxr_term.y; 
dvi  Ivlh.z  ss  idot.z  4-  wxr  t«m.z; 
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for(j»0;  j<3;  j++) 

{ 

fo»(i«0;  i<3;  i++) 

{ 

gcl[i][i]  *  icg(i][>l: 

} 

} 

vector_tnuufonii(&dvlJvlh.  &dvl_M50_l.  gel); 

dvl_M50->x  *  vel_t.x  +  tlvl_M50_l.x  -  vel_o.x; 
dvl_M50->y  »  vel_t.y  +  dvl_M50_l.y  -  vel_o.y; 
dvl_M50->i  »  vel_t.z  +  dvl_M50_l.z  -  vcl  o.z; 

/* - 


dv2jvlh.x  =  (2'*‘rdol.y*sin(w*ttr)+(4’'tdot.x-6'^v*ro.y)*cos(w*ttr)+ 
6*w*ro.y-3'*rtot.  x); 

dv2_Iv!h.y  =  ((3’*V*ro.y  -  2*rdot.x)*sui(w*ttr)  +  rdot.y*cos(w*ttr)); 
dv2_lvlh.z  =  rdot.z'''cos(w‘*«r)  -  ro.z’'\v‘*^in(w*ttr); 


next  we  have  to  propogate  the  target  again  to  a  time  ttr  plus  where  we 
we  are  right  now  (a  second  propagation) 


/* - 

*/ 

bgprop(chaser*>time,  &pos_t,  &vel_t,  P,  ttr,  step,  &pos_tnew,  &vel_tncw); 

magpos_t  —  vector_magnitude(&pos_tnew); 

gcl[0][]]  =:  pos_tnew.x  /  oiagpos_t; 
gcl[l][l]  =  pos_tnew.y  /  niagpos_t; 
gcl[2][l]  —  pos_tnew.z  /  magpos  t; 

/* - 

*1 

vector_cross(d^s_tnew,  &ve)_tnew,  &xtxvt); 
magxxv  =  vector_magnitude(&xtxvt); 

gcl[0][2]  *  hhat.x  =  xtxvt.x  /  magxxv; 
gcl[l][2]  —  hhat.y  =  xtxvt.y  /  magxxv; 
gcl[2][2]  =  hhat.z  »  xtxvt.z  /  magxxv; 

vector_cross(dl4>os_tnew,  &hhat,  &vb); 

magvbar  —  vector_magnitiide(&vb); 
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gcl[0][0]  s  vb.x  /  magvbar; 
gcl[l][0]  =  vb.y  /  magvbar; 
gcl[2i[0]  *  vb.z  /  magvbw; 

vector_tf«nsform(&dv2_lvUi,dv2_MS0,gcl); 

} 


*  getquat('*'qiut,  ''Arbiter)... produces  a  quatemian  for  the  attitude  of  the 
orbiter  "Qbl”  based  on  its  position  and  velocity.  This  is  by  no  means 

*  an  implication  that  this  propogates  the  orbiter  attitude.  This  is  however 
a  way  of  creating  a  time  varying  quatemian  based  on  a  desired  attitude, 
this  function  is  currently  designed  to  produce  a  gravity  gradient  position 
with  the  payload  bay  facing  aft,  as  if  preparing  to  rendezvous. 

*  - */ 

void  getquat(void) 

{ 

Vector  pos_o,  vel_o,  bl,  b2,  b3,  rxv,  blxb2; 
double  A,  B,  C,  ma^s,  magrxv,  magblxb2; 
int  good_quat,  i; 

pos_o  »  tans.pos; 
vcl_o  =  tans.vel; 

/♦ - 

*/ 

nnagpos  »  vector_magnitude(&pos_o); 
bl.x  s  pos_o.x/magpos; 
bl.y  »  pos_o.y/magpos; 
bl.z  =  pos_o.z/magpos; 

vector_cross{&pos_o,&vel_o,&rxv); 
magrxv  s  vector_magnitude(&rxv); 
b2.x  =  -rxv.x/magrxv; 
b2.y  =  -rxv.y/magrxv; 
b2.z  =  -rxv.z/magrxv; 

vector_cross(&bl  ,&b2,&blxb2); 
magblxb2  =  vector_magnitude(&blxb2); 
b3.x  s  blxb2.x/magblxb2; 
b3.y  s  blxb2.y/magblxb2; 
b3.z  s  blxb2.z/magblxb2; 

/• - 

*/ 

A  =  bl.y  +  b2.x; 

B  ■  b2.z  +  b3.y; 

C  =  bl.z  +  b3.x; 
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if(  fobs(B)  l.Oe-8  ) 

{ 

orb_quat.x  »  «qit(A*C/4.0/B); 
if(  ia^orb  qiiat.x)  >  «  l.Oe-8  ) 

{ 

orb_quat.y  ^  A/4.0/orb_qiut.x; 
orb_qii«t.z  =  C/4.0/orb_quat.x; 
if(  fi^orb  quat.y)  >«  l.Oe-8  ) 

{ 

orb  quat.s  »  (bl.z  -  2*orb_quat.x*orb_quat.z)/2/orb  quat.y; 

} 

else 

{ 

orb_quat.y  =  orb_quat.z  =  0.0; 
orb_quat.s  =  orb_quat.x  =  0.7071; 

} 

} 

else 

{ 

orb_quat.y  =  orb_quat.z  =  0.0; 
orb  quat.s  =  orb  quat.x  =  0.7071; 

} 

} 

else 

{ 

orb_quat.y  =  orb_quat.z  =  0.0; 
orfo_quat.s  =  orb_quat.x  =  0.7071; 


*! 

good_quat  **  NO; 
orb  quat.x  s  •orb_quat.x; 
i  =~0; 

while  (good  quat  =  «  NO) 

{ 

orb_quat.x  =  -orb_quat.x; 
good_quat  =  testquat(&bl,&b2,&b3); 

i++; 
if(i  >  2) 

{ 

orb_quat.y  =  orb_quat.z  —  0.0; 
orb_quat.s  =  orb_quat.x  *  0.7071; 
good  quat  ^  YES; 

} 

} 

orb_quat.tiiiie  =  tans.time; 
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SSSSSSSSSSSBSSBSSSSSSSaBKmSB&JSSS 

This  function  evaluaUes  die  valitity  of  the  reUtion^p  between  a 

*  quaternion  and  a  DCM  conqiosed  of  three  ortfa<»onnal  vectors  as  the  rows 

♦  - •/ 

int  testquat(Vector  *bl.  Vector  *b2.  Vector  *b3) 

{ 

double  dif; 
bt  good_quat; 

dif  =  fabs(bl->y  -  2'''(orb_quat.x'*'OTb_quat.y-orb_quat.s'''orb_quat.z)); 
dif  =  dif  +  fsbs(bl->z  -  2*(orb_quat.x*orb_quat.z+orb_quat.s*orb_quat.y)); 
dif  =  dif  +  fabs(b2->x  -  2*(orb_quat.x*orb_quat.y+orb_qual.s*orb_quat.z)); 
dif  *  dif  +  iabs(b3->x  -  2*(orb_quat.x*orb_quat.z-orb_qual.s*orb_qual.y)); 
dif  =  dif  +  fid)s(b3->y  -  2*(orb_quat.y'''orb_quat.z+orb_quat.s*orb_quat.x)); 
dif  =  dif  +  fabs(b2->z  -  2*(orb_quat.y*orb_quat.z-orb_quat.s’'‘orb_quat.x)); 

if(  dif  <  l.e-6  ) 

{ 

good_quat  »  YES; 

} 

else 

{ 

good  quat  ==  NO; 

} 

return(good_quat); 
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;  Public  Domain 

;  *  Thomas  J.  Silva  and  Brace  G.  Jackson  &.  Associates,  Inc. 

•  * 

ideal 

model  large, C 
include  *com_port.inc* 


codeseg 
locals _ 

PORT  equ  (Com_port_info  es:bx) 
BFR  equ  (Comjport_buffer  es:bx) 


int  _com_port_reset(Com_port_info  "^rt) 

1  check  for  the  existance  of  the  com-chip,  then  I  reset  the  chip  a  known 
initial  state.  1  return  an  existance  flag: 

ax  =  0  NO,  chip  doesn’t  respond 

ax  >  0  OK,  chip  initialized  to:  9600-O-8-J,  no  interrupts 

Trashed:  ax  bx  cx  dx  es 


REG_2_IN1T  «  ACC_w2_rx_fifo_14  +  ACC_w2_fifo_on 

REG~4_INIT  =  ACC~rw4_RTS  +  ACC_rw4_DTO  +~ACC_rw4_output2 

proc  _com_port_reset 

arg  arg_PORT:ptr  Com_port_info 


9 

les  bx,[arg_PORT] 

mov  dx,[PORT.port] 


Test  for  the  chip’s  presence  by  loading  the  divisor  latch  and  reading  it 
back. 


ACC  WR 

3,mov,ACC_rw3_dlab 

;Access  the  divisor  latches 

ACC  WR 

0,nx>v,0fah 

;load  up  registers  0  &  1  with  a  pattern 

ACC  WR 

l,mov,Odeh 

ACC_RD 

0 

mov 

ch,al 

ACC_RD 

1 

mov 

cl,ai 

ACC_WR 

3,mov,0 

;Tum  off  divisor  access 

com  Inta.asm 
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cnq> 

cx,01adeh 

_reset 

;if  (register  pattern)  return  NO 

xor 

ax,ax 

jmp 

short  _d<Mie 

Put  the  chip  into  a  known  state:  interrupts  off,  fifos  enabled,  9600 


;  baud,  RTS  DTR  and  OUT2  enabled 

• 

reset: 

;lnitialize  the  chip: 

ACC  WR 

l,mov,0 

;  Ttim  off  intemq>ts 

ACC~WR 

2,mov,REG_2_INIT 

;  nfos  enabled,  14-char  rx  ftfo  trigger 

ACC~WR 

3,mov,ACC_rw3_dlab 

;  Divisor  latdi  access 

ACC"WR 

0,mov,0ch 

:  BRG  count  b  12,  9600  baud  (with  xl6  clock) 

ACC  WR 

l,mov,00h 

ACC"WR 

3,mov,ACC_rw3_8bits 

;  DLAB  off,  rx/tx  8  bits,  no  parity,  1  stop 

ACC“WR 

4,naov,REG_4_INIT 

;  RTS,  DTR,  01JT2  (connects  intemipt  line) 

ACC  RD 

5 

ACC_RD 

6 

;read  line/modem  status  to  clear  them 

mov 

al.l 

;retuni  OK 

done: 

ret 

endp 


void  _coni_port_set(Conij;>ort_info  "'port,  ushort  divisor,  int  parity,  int  stops) 
I  set  the  baud-rate  divisor  latches,  the  caller  must  compute  the  divisor. 
Trashed:  ax  bx  dx  es 


proc  _com_port_set 

ai:g  arg_PCRT:ptr  Com_port_info,  arg_DIVISOR:word,  aTg_PARITY :word,  arg_STOPS:word 


ies 

bx,[arg_PORT] 

mov 

dx,[PORT.port] 

mov 

bx,[aig_DIVISOR] 

ACC  WR 

3,mov,ACC  fw3  dlab  +  ACC  rw3  8bits 

ACC  WR 

0,mov,bl 

ACC_WR 

l,mov,U) 

mov 

ax,[aig  PARITY] 

or 

ax,[arg_STOPS] 

and 

al,lch 

COB  inta.asm 
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ACC_WR  3,or,ACC_rw3_8bits 


let 

eiK4> 


void  _coinj)ort_intr_catch(Com_poft_info  *poit) 

1  perform  these  tasks: 

Save  the  old  interrupt  handler 

Create  the  new  interrupt  handler  entry  point 

install  the  new  handler 

Enable  the  interrupt  control  line 

Enable  the  chip’s  interrupts 

Trashed:  ax  bx  cx  dx  es 


proc  _com_port_intr_catch  uses  ds 

arg  arg_PORT:ptr  Comjx>rt_info 


* 

;  Get  and  save  the  current  interrupt  handler. 

ies 

bx,Iarg_PORT] 

mov 

al,[PORT.irq] 

add 

al,PC_int_irqO 

mov 

cl,al 

mov 

ah.35h 

int 

21h 

mov 

ax,bx 

mov 

dx,es 

Ies 

bx,[arg_PORT] 

mov 

[PORT.oid_handler.ofr],ax 

mov 

P’ORT.old_handler.seg],dx 

;al  »  base  interrupt  id  irq 


;get  and  save  the  current  handler 


;  Create  a  small  interrupt  handier  at  the  beginning  of  the  port  structure. 
;  This  code  will  call  the  base-lumdler  below,  which  will  then  be  able  to 
;  find  the  port  structure. 

mov  [PORT.entiy.op  es],OP  PU^  ES 

mov  [PORT.entiy.op'bxl.O^PUafBX 

mov  [PORT.entry.op_nop],OP_NOP 

mov  [PORT.eotiy.op_call],OP_CALLF 

mov  [PORT.entry.himdler.off],of^  _bandler 

mov  [PORT.entty.handler.seg],cs 
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;  lutall  tbe  new  interrupt  handler  for  this  IRQ. 


mov 

dx.es 

mov 

ds,dx 

mov 

dx.bx 

mov 

ah.2Sh 

mov 

al,cl 

int 

21h 

handier 


;ds:dx  •>  port  structure 

;uutall  the  propo-  intmrupt 


the  mask 


t  •-••••• 

;  Tell  the  intemqM  controller  to  enable  my  interrupt  line. 

» 

mov 

ci,[PCMtT.irq] 

mov 

sh.l 

shl 

ah.cl 

mov 

[P(XtT.irq_maak],ah 

;my  bit  mask  ^  i  <  <  irq 

cli 

u 

;di8able  interrupts  while  1  change 

in 

al.PCJCO_rl 

;al  K  current  interrupts-enabled  mask 

mov 

cl,al 

not 

ah 

and 

al,ah 

:al  —  cuiTeot_mask  &  ~my_mask 

out 

PC_IOO_rl,al 

;set  new  intemipt  mask  with  my  interrupt  on 

sti 

not 

ah 

and 

cl,ah 

;I  must  remember  is  tbe  interrupt  was  off 

J2 

_do_chip 

or 

(PORT.status],COM_PORT_irq_was_ofT 

f 

;  Tell  the  chip  to  enable  interrupts  for  rx  and/or  tx. 

* 

_do_chip: 

mov 

ax,[PORT.status] 

xor 

cl,cl 

;initial  mask  —  0 

test  ax,COM_PORT_rx_eoabled 
jz  _dik_tt 

or  cl.ACC  rwl  int  rx 


;if  (rx_eoabIed) 

;mask  |  ^  rx_int_niadc 


_dik_tx: 

teat  ax,COM_PORT_tx_enabIed 
jz  set  iw 

or  cl,ACC  rwl  int  tx 


;if  (tx_enabled) 

;mask  | »  tx  int  mask 


_8et_ier: 

mov 


dx,[PORT.poft] 
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ACC_WR  l.mov.cl  ‘.Enable  intemipU 


rat 

eadp 


void  _com_jx>rt_mtr_inicatch(Coin_poit_iiifo  *port) 

I  perform  theae  taaks: 

Disable  the  chip’s  interrupts 

Disable  the  interrupt  controller  (for  my  mtemq>t) 

Restore  the  old  handler 

Trashed:  ax  bx  cx  dx  es 


proc  _com_port_intr_uncatch  uses  da 

arg  arg_PORT:ptr  Com_poft_info 


:  Tell  the  chip  to  disable  all  intem^rts. 

t 

les  bx,[arg_PORT] 

mov  dx.fPCmT.port] 

ACC_WR  l.mov.O  ;Disable  interrupts 


;  Tell  the  interrupt  controller  to  disable  my  intmrupt  line,  but  rally  if 
;  it  was  disabled  when  I  began. 

test  (PORT.statusl,COM_PC»T_irq_was_ofF 


j* 

cli 

_do_handler 

;if  (it  was  disabled) 

in 

al,PCJOO_rl 

;al  s  current  intemipts-enabled  mask 

or 

al,[PORT.irq_niask] 

;al  |s  my_mask 

out 

sti 

PCJCO_rl,al 

;turn  off  my  interrupt  line 

do_handler: 


les 

bx,[stg_PORT] 

mov 

al.[PORT.irx]] 

;a]  s  base  interrupt  id  -f  irq 

add 

at, PC  int  irqP 

mov 

ah,2Sh 

Ms 

dx,[PORT.old  handler.ptr] 

int 

21h 

;re8tora  the  old  handler 

♦ 

ret 

COB  Inta.ai 
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int  _coai_port_jet(Coaij)ort_iiifo  *port) 


I  get  the  next  bsrte  from  the  receive  queue.  I  return  the  value  aa  follows: 
ax  »  OxfffF  Queue  empty  (-1) 
ax  »  OxOOxx  Low  byte  has  value,  high  1^  is  zero 

Trashed:  ax  bx  es 


proc  _com_port  jgA  uses  ds  si 

arg  arg_P(MtT:ptr  Com_port_infb 


lea 

lea 

cM 

cli 

caU 

sti 


bx,[arg_PCMlT] 

bx,[PORT.rx]  ;es:bx  ->  rx  buffer 


near  _buffBr _get  ;get  otm  byte  frcHn  buffer 


jnz 

got  byte 

xor 

ax.ax 

dec 

ax 

jmp 

short 

not  byte: 

xor 

ah.ah 

;if  (queue  empty) 

;value 


;else 

;high_b3^  =  0 


endp 


* 

_dooe: 

ret 


int  _com_portjput(Comjxnt_info  *port,  ushort  value) 

I  put  a  byte  into  the  transmit  queue.  I  return  a  flag  as  follows: 
ax  «  0  Queue  full 
ax  =  1  Ok 

Trashed:  ax  bx  dx  es 


proc  _com_port  jwt  uses  ds  di 

arg  arg_PCMlT:ptr  Com_port_info,  arg_VALUE:word 


can  Inta.asn 


con  inta.Ai 


endp 


mov  ax,[arg^VALUE]  ;al  »  byte  to  send 

les  bx.tais  PORT) 

cid 

cli 

test  IP(MlT.8tstii8],CX)M_PORT_tx_stopped 


_tx_put 

;if  (tx_stopped) 

mov 

dx.[P(MlT.poft] 

out 

dx,al 

'.send  the  bj 

and 

[PORT.status],not  COM_PORT_tx_stopped 

mov 

ax.l 

jnv 

short  _doiie 

tx_put: 

;e]se 

lea 

bx,tPORT.txl 

;es:bx  •>  tx  buffer 

call 

near  _bufferj>ut  ;put  tme  byte  into  buffer 

done: 

sti 

ret 


1  get  one  firom  s  buffer. 


;  Inputs: 

;  Returns: 

;  Trashed: 

es:bx  •>  buffer  structure 
direction  up 

ah  «  0  if  no  data,  >0  if  ok 
al  »  value 

ZR/NZ  follows  ah 
ax  si  ds 

proc  _buflfBr _get 

near 

mov 

ax,[BFR.bused] 

or 

ax,ax 

j* 

_doiie 

;if  (buffer.used  ==  0)  return  NO 

Ids 

si,[BFR.bstart.ptr] 

add 

si,[BFR.btaU] 

;ds:si  ->  tail  byte 

lodsb 

;al  *  *taU+  + 

sub 

si,[BFR.bstart.ofl] 

cmp 

si.[BFR.bsize] 

con 
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jb 

_iet_taU 

;if  (tail  >  size) 

xor 

_iet_tail: 

■i.ai 

;taU  = 

mov 

[BFR.btaill.si 

dec 

[BFR.buaed] 

or 

•h.1 

;return  YES 

_done: 

rat 

endp 


1  put  one  byte  into  a  buffer. 


Inputs:  es:bx 

Returns:  ax  > 

Trashed:  ax  di 

->  buffer  structure 
al  «  value 

0  if  full,  1  if  ok 

ZR/NZ  follows  ax 
ds 

9 

proc  _bufrer jMit  near 

mov 

di,[BFR.bused] 

cmp 

di,[BFR.bsize] 

.0 

0 

Z 

put  byte 

;if  (buffer.used  >  ^  buffer.size)  return 

xor 

rat 

ax.ax 

_ put_byle: 

ids 

di,[BFR.bstart.ptr] 

add 

di.[BFR.Uiead] 

;ds:di  ->  head  byte 

mov 

[di].ai 

;al  =  '*'head+  + 

inc 

di 

sub 

di,[BFR.b8tart.off] 

ctap 

di,[BFR.bsize] 

jb 

set  head 

;if  (head  >  size) 

xor 

set  head: 

di,di 

;head  »  0 

mov 

[BFR.bhead],di 

inc 

[BFR.buaed] 

xor 

ax,ax 

inc 

ret 

endp 

ax 

;retura  YES 

com  inta.am 


COB  Inta.csB 


1  am  the  intem^rt  fiinctioa  for  the  tx_en4>ty  cmadition. 

Inputs:  es:bx  ->  port  info  structure 

dx  s  port 


Trashed:  ax  cx  si  ds 


proc  _tx_empty  near 


mov  cx.bx 

lea  bx,(PORT.tx]  :es:bx  ->  tx  buffer 


;  Loop  while  the  chip  can  take  more  bytes. 

f 

_ loop: 


;for  (;;) 


ACC_RD  S  ;get  line  status 

test  al,ACC_r5_tx_en]pty 

jz  _done 

call  _buffer_get 

jz  _ tx_stopped 

out  dx.al 

Jmp  _ loop 

_tx_stopped: 

mov  bx,cx 

or  [PORT.statusl,COM_PORT_tx_stopped 


;if  (tx  foil)  break 
;get  one  byte  from  buffer 
;if  (got  one  ok) 

;sead  the  byte 
;continue 

;else 


endp 


_done: 

mov  bx,cx 

ret 


I  am  the  interrupt  function  for  the  rx_ready  condition. 

Inputs:  es:bx  ->  port  info  structure 

dx  =  port 


;  Trashed:  ax  cx  di  ds 

^  mmmmmmmm  .mmmm ........... ............. 

proc  _rx_ready  near 


mov  cx,bx 

lea  bx,[PORT.rx]  ;es:bx  ->  rx  buffer 
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Loop  while  the  chip  hu  more  bytes. 


in  el.dx 

call  buffBr_put 
ACC_RD  5 

test  aI,ACC_r5_rx_avail 
jnz 


;ft>r  (;;) 

‘.get  byte 

;put  one  byte  into  buffer 

;get  line  status 

;if  (rx  not  ready)  break 


endp 


_ done: 

mov  bx.cx 

ret 


1  am  the  interrupt  handler,  1  expect  to  be  called  by  the  snippets  of  code 
created  above  by  the  _catch  routine. 


proc  _handler 


;  Retrieve  the  port_info  pointer  off  the  stack,  es  and  bx  have  been  saved 
;  on  the  stack,  I  must  save  others. 

f 

sti 
cld 
pop 
pop 
sub 

push  ds 
pusha 


;  Loop  while  I’ve  got  something  to  do.  The  es,  bx,  and  dx  registers  must 
;  be  maintained  across  subroutine  calls. 

mov  dx,[PORT.port] 

_ loop: 

cli 

ACCRD  2 

test  al,ACC_r2_int_pending 
jnz  _int_clr 


xor 

ah,ah 

and 

al,ACC_r2_int_type  . 

mov 

si,ax 

com  Inta.asm 


;while  (mterrupts  p«ding) 

;get  interrupt  id  flags 


bx 

es 

bx,8  ;es:bx  -  >  port  pointer 


co9B_lnta.a«m 

jmp  [cs:iwitch-f-si]  ;switch  (iiitemipt_type) 

switch  dw  _csse_iiKxieai_8Ut,  _ca8e_tx_empty 

dw  _cssc_fx_»vail,  _case_line_8tat 


status  to  clear 

> 

case  modem  stat: 

"  ACC_RD  6 

jmp  _ loop 

;case  modem_8tatus: 

;read  modem 

to  clear 

• 

case  line  stat; 

~  ACC_RD  5 

jmp  _ loop 

;case  lme_status; 

;read  line  status 

• 

• 

_case_rx_avail: 

call  _rx_ready 

jmp  _ loop 

;case  rx_available: 

;empty  the  chip's  rx  queue 
;fall  through  to  tx  chk 

case_tx_cmpty:  :c*se  tx_envty: 

cdl  _tx_empty  ;fili  the  chip’s  tx  queue 

jmp  _ loop 


;  Clear  the  interrupt  controller,  release  this  interrupt  line  and  all  the 
;  lower  priority  lines. 

* 

_ int_clr: 

cli 

mov  ai,lC_eoi 

out  PC_ICO_iO,al  ;End-of*intemq)t  command 

done: 

popa 

pop  ds  bx  es 

iret 

oidp 


public  _com__port_reset,  _com_poTt_set 

public  _com_port_intr_catch,  _com_port_intr_uncatch 

public  _com_port_get,  _com_port_put 


end 


com  Inta . asm 


com  Intc.c 


*  Public  Domain 

Thomas  J.  Silva  and  Bruce  G.  Jackson  &  Associates,  Inc. 

* 

* - */ 

finclude  <alloc.h> 

^include  <com_poit.h> 

static  Com_port_info  com_ports[COM_PORT  max]  = 

{ 


}; 


/*  entry 

status  port 

irq  */ 

{{0}. 

COM  PORT  tx  stopped. 

0x0318,  4}, 

{{0}. 

COM  PORT  tx  stopped. 

0x02f8,  3  }, 

{{0}, 

COM  PORT  tx  stopped. 

0x03e8, 

4}, 

{{0}. 

COM_PORT_tx_stopped, 

0x02e8, 

3} 

II  II 

II  II  ! 

II  II  i 

II  II 

II  II 

=  =  =  = 

static  Comj)o.i  n  ’•'comjwrt  verify(int  port  id) 

if  (port  id  >  0  &&  port  id  <  =  COM  PORT  max) 

{  ■ 

Comjport_info  "Twrt  =  com_ports  +  port_id  -  1; 
if  (port- >  status  &  COM  PORT  in_use)  return  port; 

} 

return  NULL; 

} 


Returns: 

0  No:  bad  id,  port  in  use,  chip  doesn’t  respond,  or  out  of  memory 

*  1  Ok: 

*  - */ 

int  com_port_start(int  port_id,  ushort  rx  bsize,  ushort  tx  bsize) 

{ 

Comjx)rt_info  *port  =  com_ports  +  port_id  -  1; 

/* - 

*  Check  the  port  number  for  validity,  make  sure  it’s  not  already  in  use. 

*  Then  make  sure  the  chip  for  that  port  responds  (i.e.  it  exists). 

•/ 

if  (port_id  <  **  0  II  port_id  >.  COM_PORT_max 
I  I  port- >  status  &  COM_PORT_in_use)  return  NO; 

if  (_com_port_reset(port)  =  *  NO)  return  NO; 
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/* - 

Allocate  the  rx  and  tx  buffers. 

if  (rx  bsize) 

{ 

if  ((port->rx.start  =  maUoc(port->rx.size  =  rx_bsize))  ==  NULL) 
return  NO; 

port->rx.used  *  poTt->rx.head  =  port->rx.tail  =  0; 

} 

if  (tx  bsize) 

{ 

if  ((port- >tx.  start  =  malloc(port->tx.size  =  tx_bsize))  =»  NULL) 

{ 

if  (rx_bsize)  free(port->rx.start); 
return  NO; 

} 

port->tx.used  =  port->tx.head  =  port->tx.tail  =  0; 

} 

/* - 

This  port  is  now  in  use,  it  is  not  currently  transmitting. 

*! 

port- >  status  =  COM_PORT_in_use  |  COM_PORT_tx_stopped; 

if  (rx_bsi2e)  port- >  status  j=  COM_PORT_rx_«»bled; 
if  (tx_bsi2e)  port- >  status  |=  COM_PORT_tx_enabled; 

/* - 

*  Install  the  proper  interrupt  handler,  and  enable  die  chip’s  interrupts. 

*! 

_comjx)rt_intr_catch(port); 
return  YES; 

} 

Returns: 

*  0  No:  bad  id,  or  port  not  in  use 

*  1  Ok: 

*  - */ 

int  com_port  stop(int  port  id) 

{ 

Com_port_info  "port  *=  com_port_verify(port_id); 

/* - 

Shut  off  the  chip’s  interrupts,  and  remove  the  interrupt  handler. 

*! 

if  (port  =  =  NULL)  return  NO; 
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_coinjsort_intr_iiiic*tch(port); 

port- >  status  »  COM_PCMlT_tx_stopp«d; 

/♦ - 

*  Free  the  rx  and  tx  buffers. 

*/ 

if  (port- >rx. size)  {  free(port->rx.start);  port->rx.size  -  0;  } 
if  (port->tx.size)  {  free(port->tx.stai1);  port->tx.si2e  ^  0;  } 
return  YES; 

} 

■"  Returns: 

0  No:  bad  id,  or  port  not  in  use 

*  1  Ok: 

*  - *! 

int  com_port  set(int  port  id,  long  baud,  int  parity_flag,  int  stop  bits) 

Coni_port_info  *port  =  comjx)rt_verify(port_id); 
usbort  divisor; 

/* - 

*1 

if  (port  =  =  NULL)  return  NO; 
divisor  =  (ushort)(COM_PORT_clock  /  baud)  /  16; 
_comjx>rt_set(port,  divisor,  parity_flag,  stop_bits); 
return  YES; 

} 

Returns: 

-1  No:  bad  id,  port  not  in  use,  or  queue  empty 
'*  OOxx  CMc:  high  byte  zero  and  value  in  low  byte 

* - */ 

int  com_port _get(int  port  id) 

{ 

Com_port_iiifo  •port  =  com_j)ort_verify(port_id); 

/* - 

•/ 

if  (port  NULL)  return  -1; 


com  intc.c 
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reAini  conij>ort _get(port); 

} 


/*» 


*  Returns: 

-1  No:  bed  id,  or  port  not  in  use 

*  0  No:  queue  empty 

*  >0  (%:  number  of  bytes 

*  _ 


#ifdef  NOT_YET 

int  com_port  reed(int  port_id,  ubyte  '^vhere,  int  size) 

{ 

Com_port_info  *port  =  comjx)rt_verify(port_id); 


} 


.*/ 


/* - 

*/ 

if  (port  ==  NULL)  return  -1; 
return  _comjiort_read(port,  where,  size); 

#endif  NOT_YET 


*  Returns: 

*  0  No:  bad  id,  port  not  in  use,  or  queue  full 

*  1  Ok: 

int  comjx>rt_put(int  port  id,  ubyte  value) 

{ 

Comj)ort_info  ♦port  =  comjx)rt_verify(port_id); 

/* - 

*/ 

if  (port  =  s=  NULL)  return  NO; 
return  _comj)ort_put(port,  value); 

} 


/♦=« 


♦  Returns: 

♦  -1  No:  bad  id,  or  port  not  in  use 

♦  0  No:  quMie  full 

♦  >0  <%:  number  of  bytes 

♦  - ♦/ 


jWfdef  NOT_YET 

int  com_port  write(int  port_id,  ubyte  ♦where,  int  size) 

{ 


com  intc.c 
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Com_port_info  •port  *  com_port_verily(port_id); 

/• - 

*/ 

if  (port  »  s  NULL)  return -1; 


return  com_port  write(port,  where,  size); 

> 

«todif  NOT_YEr 


con  Intc.c 


orb  filo.c 


/■»* 


* - */ 

iKnclude  <stdio.h> 
iNnclude  <io.h> 
finclude  <fcntl.h> 

#iiicliide  <edit.h> 
jKnclude  <frict_if.h> 


* - */ 

static  int  file_status,  file_handle_rx  —  -1; 

//  static  int  file_handle_tx  —  -1; 
static  FILE  ♦file_rx  =  NULL; 

#define  HLE  IS  DEVICE  0x0080 

#defuie  nLElN6T_EOF  0x0040 

#define  FILE  IS  RAW  0x0020 
#define  HLEIsET  BITS  OxOOff 


* - 

int  orb_port  initQ 

{ 

char  ’'‘filename; 

/* - 

*1 

filoiame  =  edit_text(''Enter  Orbiter  file/device:  *,  "comZ”); 
return  orb_port  init_byname(filename); 

} 


♦ - */ 

int  orb_port  init_byname(char  ^filename) 

{ 

/♦ - 

*! 

if  ((file  handle  fx  »  opeo(fileoame,  O  RDWRjO  BINARY))  <  0) 
{  ■  " 

printf(*Can’t  open  fUe/device  %s\n*,  filename); 
return  NO; 

} 


!*■ 


orb  filo.c 
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*  If  input  file  u  a  device,  place  that  device  in  "ttn/"  mode.  Otlierwiae 

*  leopen  using  buflerad  I/O. 

*/ 

file_Matus  w  iocti(file_handle_rx,  0.  0,0); 

if  (file  status  &  FILEJS  DEVICE) 

{ 

file_status  -  (file_status  &  FILE_SET_BITS)  |  F1LE_IS_RAW  |  FILE_NOT_EOF; 
iocd(file_liandie_fx,  1,  fi)e_ststus,0); 

//  file  handle_tx  «  file  handle  rx; 

>  ■ 

else 

{ 

if  ((file  nc  »  fdopen(fiie  handle_rx,  'rb*))  * »  NULL) 

{ 

c)oae(fiie_handle_rx); 

printf(*Can’t  open  51s,  out  of  memoiyXn*.  filename); 
return  NO; 

} 

//  filename  »  edit_text(*Enter  Orbiter  ou^t  file:*,  filename); 

//  if  ((file  handle  tx  «  open(fileoame,  O  RDWRjO  BINARYjO  GREAT,  0666))  <  0) 
//  {  ■  ■ 

//  printff*Can't  create  file  %s\n*,  filename); 

//  close(file_handle_rx); 

//  return  NO; 

II) 


return  YES; 

} 


int  orbjport_stopO 

{ 

/♦ - 

*  If  input  file  is  a  device,  place  that  device  back  in  "cooked*  mode. 
*/ 

if  (file_status  &  HLE  IS  DEVICE) 

{ 

file_status  ~FILE_IS_RAW; 
ioctI(file_handle_rx,  1,  file_status,0); 
clooe(file_handle  rx); 

} 

else 

{ 

fcIose(file_rx); 

//  close(fite_handle_tx); 

orb  £ll«.c 


oxb_£iltt.c 

) 

ratufii  YES; 


/** 


*  DOS  tucks.  DOS  hu  a  bug  regardbg  devices  in  raw  mode,  this  piece  of  code 

*  fixes  the  error  caused  by  the  bug.  The  bug  occurs  under  these  conditions: 

•  You  are  reading  from  a  device  in  raw  mode. 

*  -  The  memory  you  are  reading  into  just  happeiu  to  fall  on  a  paragraph 
'*  boundary  (i.e.  the  address  is  divisible  16). 

-  The  device  driver  doesn’t  have  any  bytes  ready  for  you. 

>•> 

*  Under  these  conditions,  DOS  will  erroneously  mark  your  file  with  an  EOF 

*  flag,  after  which  readQ  will  always  fiul,  even  if  the  device  has  some  bytes 

*  ttady.  This  kludge  marks  the  file  as  not-EOF. 

*  - */ 

static  void  Ex  dos  eof  bug(void  ^location) 

{ 

if  (((uahoft)locatioo  &  15)  at  o  &&  file  status  &  P1UE_IS  DEVICE) 

{ 

file.status  I  =  FILE_NOT_EOF; 
ioct](file  handle  rx,  1,  file  status,0); 

> 

) 


• - */ 

int  orb_port _getbO 

{ 

/♦ - 

*1 

if  (file  status  St  HLE  IS  DEVICE) 

{ 

ubyte  work; 

if  (read(file_handle_rx,  &work,  1)  >  0)  return  work; 

fix_doa_eof_bug(&work); 

return  -1; 

) 

dse  return  getc(file_rx); 


•*/ 


#ifdefNOT_YET 

int  orbjNMl  read(ubyte  *where,  int  bytes) 

{ 
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if  ((^tM  «  re«d(fUe_lMMidie_TX,  viiere,  byte*))  <  «  0)  fu_dM_eof_bug(where); 
return  bytes; 

) 

HeadifNOT.YET 


orb  fllo.c 
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/*« 


* - */ 

iKaclude  <pkt_if.h> 

#incliide  <p«ck«t.h> 

(Knclude  <coiiit.h> 


The  orbiter-gps  packet  is  used  for  testing  only. 

* 

*  The  vectors  have  these  units: 

*  orbiter  vectors  are  M50  in  ft  and  ft/s 

*  spas  vectors  are  WGS84  in  ft  and  ft/s 
orb-gps  vectors  are  WGS84  in  m  and  m/s 

m 

*  The  orbiter  time  is  absolute,  001/00:00:01.000  1.0  sec  86400  secs  (one 

*  day).  The  spas  time  is  also  absolute.  The  orb-gps  time  is  also  absolute. 
- */ 

Orb_packet  orbiter_packet: 

Spas_packet  apas_packet: 

Orb jtps  packet  orbiter _gps_packet; 

int  orb_port_pkt_error; 


/♦=  = 


enum  states 

{ 

STATE_find  eb, 

STATE_find”90, 

STATE_get_type, 

STATE_fill_pkt, 

STATE_usejpkt 

}; 


static  union 

{ 

Orb_packet  orb; 
^>as_packet  qtas; 
Orb_^S)sj)acket  orb_gps; 
ub}^  buffeifl]; 

}  packet; 


* _ 

static  int  checkjiackets  »  YES; 


*/ 


orb_pkt.c 


orb_j>kt.c 

void  orbj)ort_jMidiet_clwck(iiit  oo_off)  {  checkjMckets  »  on_ofF;  } 
static  int  check_packet(v(»d); 

//  static  void  duinp_vector(State_veetor  *gv,  char  *aMg); 


*  Returns: 

*  0  Nothing  available 

*  >0  Packet  type 

*  - */ 

int  orb  j>ort_processO 

{ 

static  int  state  s  STATE_find_eb: 
static  int  buffer_index  ^  0; 
static  int  bytes_needed; 

int  packet_type; 
ushort  value; 

/* - 

*  Fill  the  packet  buffer  until:  the  packet  is  filled,  or  no  more  bytes 

*  are  available  from  the  port. 

*/ 

for  (packet_type  «  NO; 

packet_type  ==  NO  &A.  (value  =  orbjwrtjsetbO)  !=  (ushort)-l; 
packet.tmfferfbuffer  index]  value) 

{ 

switch  (state) 

{ 

/* - 

*1 

case  STATE_find_eb: 
buffer_index  *  0; 
if  (value  ! »  Ox(X)eb)  break; 
state  =  STATE_find_90; 
break; 

/♦ - 

*/ 

case  STATE_find_90: 

if  (value  *  =  0x0090) 

{ 

buffer_index+  +  ; 
state  »  STATE_get  type; 

} 

else  state  »  STATE_find_d>; 
break; 
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*1 

case  STATE _get_type: 

if  (value  *  «  PKT_orbiter)  bytes_needod  =  sizeof(Orbj>acket)  -  3; 
else  if  (value  * «  PKT_spas)  bytes_iieeded  ^  sizeof(Spas_packet)  -  3 
dse  if  (value  »  »  PKTjgps)  byte8_Deeded  «  sizeof(Orb _aM  jacket) 
else 
{ 

state  *  STATE_fiiid_d); 
break; 

} 

state  —  STATE_fillj)kt; 
buffer_index+ + ; 
break; 


/* - 

*/ 

case  STATE_fillj>kt: 
buffer_iiidex+  + ; 
if  (-l^es_iieeded  >  0)  break; 

if  (value  !=  0x(X)ef  |  j  packet.  buffer[buffer_mdex-l]  !=  OxOObe) 
{ 

state  =  STATE_find_eb; 
break; 

} 

else  state  =  STATE_usej)kt; 


} 


} 


/* - 

*! 

case  STATE_usej)kt: 

packet_type  =  check jwcketO; 
state  =  CTATE_fiiid_eb; 
break; 


/* - - 

♦/ 

switch  (packet_type) 

{ 

case  PKT_orbiter:  orbiter jacket  =  packet.orb;  break; 

case  PKT_8pas:  spas  jacket  =  packet.spas;  break; 

case  PKT_jps:  orbiter _gp8jadtet  =  packet.orb _fps;  break; 
default:  break; 

} 

return  packet_type; 


orbjpkt .  c 
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• - 

#defiiie  POS  LjOW  FT  21000000.0 
idefine  POS~HI  FT  23000000.0 
fdefiiie  VEL  LOW  FT  10000.0 
Mefiae  VEL_HI_Ff  40000.0 

fdefiiie  POS  LOW  M  (POS  LOW  FT  *  FT  TO  M) 
iKdefiiie  POS  HI  M  (POS_li  FT  *  FT  TO  M) 

#defuie  VEL  LOW  M  (VEL  LOW  FT  *  FT  TO  M) 
fdefiiie  VElIhI_m”  (VEL_Ifl_FT  *  FT_TO_M)  ~ 

static  State  vector  limits 

Iiinit_fi~»  {  {  POS  LOW_FT,  POS  HI_FT  }.  {  VEL  LOW_FT.  VEL_H1  FT }  }, 
liinit_m  =  {  {  P(M_LOW_M.  POS_HI_M  }.  {  VEL_LOW_M.  VEL_ffl_M  }  }; 


* - *! 

static  int  checkjMcketO 

{ 

int  |Mcket_type  »  packet.orb.header.type: 

switch  (pack^  Qrpe) 

{ 

case  PKT_orbiter: 
if  (check_packets) 

( 

if  (state  vector  check(&packet.orb.orfaiter  vector,  &limit  ft)  NO) 
{  ■ 

//  diiiiip_vector(&packet.orb.orbiter_vector,  "Orb"); 

packet  type  =  0; 

break;” 

} 

if  (state  vector_check(d4>«cket.orb.targct_vector,  ftlimit  ft)  =  =  NO) 

{ 

//  diuiq>_vector(&packet.orb.tai:get_vector,  "Tgt"); 

packet_type  *=  0; 

break; 

) 

} 

break; 

case  PKr_spas: 
if  (check  jiackets) 

{ 

if  (state_vector_dieck(&packet.spu.^  vector,  &limit  ft)  s  »  NO) 

{ 

//  diiii4>_vector(&packet.qias.n>s_vector,  "Spas"); 
packet_type  »  0; 
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break; 

} 

} 

break; 

case  PKT  jps: 
if  (check_packets) 

{ 

if  (state  vector  checkf&packet. orb  gps.gps  vector,  &limit_m)  =  =  NO) 

{ 

//  dump_vector(&packet.spas.gps_vector,  "OrbCps*); 

packet_type  =  0; 

break; 

} 

} 

break; 

default:  packet_type  ^  0;  break; 


return  packet_type; 


/*= 


♦ - */ 

4^fdef  GIGO 
jfinclude  <stdio.b> 

#include  <times.h> 


static  void  dump  vector(State_vector  *sv,  char  *msg) 

{ 

char  work[32]; 


time_dbl_to_string{&sv->tiine,  work); 
fprintf(stderr,  *%-6s  ^sNn”,  msg,  work); 

fjmntfCstderr/Xtpos  %9.0f  %9.0f  %9.0f\n",  sv->pos.x,  sv->pos.y,  sv->pos.z); 
(j}rintf(stderr,”\tvel  %9.0f  %9.0f  %9.0f\n*,  sv->vel.x,  sv->vel.y,  sv->vcl.z); 

} 

#biidif  GIGO 
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/*» 


l^lude  <stdio.b> 

#include  <stdUb.h> 

iKnclude  <edit.h> 
iKnclude  <coiii_poit.h> 
iKncIude  <|rict_if.h> 

static  int  port_id; 

#define  RX_SIZE  2048 

static  int  _orbjx>rt_init(int  id,  ushort  rx_size); 

1  expect  about  220  bytes  per  second,  so  a  receive  buffer  of  2048  gives  me 
*  over  9  seconds  of  buffering. 

int  orb_port  initO 

static  char  msgQ  =  "Enter  Orbiter  port  id  (RS232  coml  or  com2)  > 
int  id; 

//  ushort  rx_size  s  2048; 

/♦ - 

*/ 

I*  rx_size  =  edit_integer(''  Enter  rx  size  ",  512); 
id  =:  edit_integer(nisg,  2); 

return  _orb_port_init(id,  RX_SIZE); 

) 

int  orb_port  init_bynanie(char  '‘)>ort_nanie) 

return  orb_port_init(atoi(port_name),  RX_SIZE); 

} 


static  int  _orb_port  init(int  id,  ushort  rx_size) 

{ 

/* - 
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*/ 

if  ((port_id  =  id)  =  =  0)  return  YES; 

if  (comjx>rt_start(port_id,  rx  size,  0)  =  =  NO) 

{ 

printf(”Can’t  start  port  %d\n'',  portjd); 
port_id  =  0; 
return  NO; 

} 

com_port_set(port_id,  9600L,  COM_PORT_par_noDe,  COM_PORT_8top_l); 
return  YES; 

} 


int  orb_port  stopO 
{ 

if  (port_id)  comjx)rt_stop{port_id); 
return  YES; 


* - ♦/ 

int  orb_portjgetbO 

{ 

return  (portjd  ?  coni_port_get(portJd)  :  -1); 

} 


* - ♦/ 

#ifdef  NOT_YET 

int  orb_port_read(ubyte  *where,  int  bytes) 

{ 

return  conijx>rt  read(port  id,  where,  bytes); 

} 

#cndif  NOT_YET 
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/*aessasssae: 


* - */ 

iNncIude  <tans_pkt.h> 

#include  <pkt_if.h> 


* - *! 

jMefine  DLE  0x10 
#define  ETX  0x03 


Returns: 

0  NO  =  Still  collecting  bytes,  nothing  available  yet 

*  1  YES  -  Got  something,  could  be  good  or  bad 

*  - */ 

int  tansj)acket_recv(Tans_packet  ’"packet) 

{ 

int  value; 

/* - 

*! 

for  (;;)  switch  (^ket->  state) 

{ 

/* - 

Here  I  get  bytes  and  fill  in  the  raw  buffer  until  1  find  the  DLE 
that  starts  the  packet. 

* 

*  If  I  have  received  more  than  just  the  DLE,  then  1  return  OK  to  give 
*"  my  caller  a  chance  to  do  something  with  the  garbage  data.  1  remove 
*"  the  DLE  from  the  buffer  first:  it  is  not  part  of  the  bad  data. 

■"/ 

case  TANS_state_find__stait: 

if  ((value  =  tans_poTt_getbO)  =  =  -1)  return  NO; 

packet- >raw[packet'>niw_8ize]  »  (ubyte)value; 

if  (-l■-^packet->^aw  size  >=  TANS  PKT_SIZE  RAW) 

{ 

packet- >  state  =  TANS_state_oversize; 
return  YES; 

} 

if  (value  !  =  DLE)  continue; 

if  (packet- >raw_size  !—  1) 

{ 

packet-  >  raw_size“; 
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packet- >  state  =  TANS_state_had_gigo: 
return  YES; 

} 

packet- >  state  =  TANS  state  packet  start; 
continue; 


*  Here  I  recover  from  the  ctmdition  where  I  found  bad  bytes  before 
the  start-of-packet.  I  fdl  through  to  the  next  state. 

*/ 

case  TANS  state  had  gigo: 
packet- >raw[0]  =  DLE; 
packet- >raw_size  =  1; 

I*  packet- >  state  =  TANS  state  packet  start;  —  Redundant  *! 

*  Here  1  initialize  the  cooked  buffer  with  the  start-of-packet  DLE. 

'*  1  fall  through  to  the  next  state. 

*1 

case  TANS  state  packet  start: 
packet- >cooked[0]  =  DLE; 
packet- >cooked_size  =  1; 
packet- >  state  »  TANS  state  find  end; 


*  Here  I  get  bytes  and  fill  in  both  buffers  until  I  find  the  DLE  that 

*  ends  the  packet.  I  fall  through  to  the  next  state  when  I  find  a  DLE. 
*/ 

case  TANS  state  find  end: 

if  ((value  =  tans_port_getbO)  ==  -1)  return  NO; 

packet- >raw[packet->raw_si2e]  = 

packet- >cooked[packet->cooked_size]  =  (ubyte)value; 

if  (-h -f- packet- >raw_size  >=  TANS_PKT_SIZE_RAW 
II  -h -1-packet- >cooked_size  >  =  TANS_PKT_SIZE_COOKED) 

{ 

packet- >  state  =  TANS  state  oversize; 
return  YES; 


if  (value  !=  DLE)  continue; 
packet->state  »  TANS  state  found  die; 


*  Here  I  get  one  byte  and  check  for  ETX  or  DLE.  I  always  save  the 
byte  in  the  raw  buffer,  but  not  always  in  the  cooked  buffer. 

*  A  DLE  will  smd  me  back  to  the  _find_end  state,  an  ETX  will  send  me 
*'  to  the  jiacket_ok  state,  any  other  value  sends  me  to  _packet_bad. 
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*  If  the  packet  ia  done,  then  I  return  OK  to  pve  my  caller  a  chance 

*  to  do  something  with  the  packet  (good  or  bad).  For  bad  packets.  I 
remove  the  DUE  and  non-ETX  bytes  from  the  buffer  first;  they  are  not 

'*  part  of  the  bad  data. 

*/ 

case  TANS_state_found_dle: 

if  ((value  »  tans_port_^etbO)  "  =  -1)  return  NO; 

packet- >raw[packet->raw_size*t--t-]  s  (ubyte)value; 

if  (value  *  =  DUE) 

{ 

packet- >  state  ■=  TANS  state  find  end; 
continue; 

} 

if  (value  ETX) 

{ 

packet-  >  cooked[packet-  >  cooked_size  -f  -t-  ]  =  (ubyte)value; 
packet- >  state  »  TANS  state  packet  ok; 

} 

else 

{ 

packet- >  raw_size  -*=  2; 

packet- >  state  s  TANS  state  packet  bad; 

} 

return  YES; 


/* - 

Here  I  recover  from  the  condition  where  1  found  a  bad  packet.  I’ve 
got  two  bytes  that  might  be  ok:  DLE  and  whatever  I  found  after  DUE. 

*! 

case  TANS  state  packet  bad: 

packet- >raw[0]  »  packet- >cooked[0]  =  DLE; 

packet- >rsw[l]  *  packet- >cooked[l}  =  packet- >raw[packet->raw_size  •¥  1]; 

packet- >raw_size  —  pad(et->cooked_si2e  =  2; 

packet- >  state  =  TANS_state_find_end; 
continue; 


/* - 

Here  I  reset  all  the  counters  and  start  lodung  for  DLE  again. 

*/ 

case  TANS  state  packet  ok: 
case  TANS_state_oversize: 

packet- >raw_size  »  packet- >cooked_size  =  0; 
packet- >  state  =  TANS_state_fiiid_start; 
continue; 
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fiaclude  <ildio.h> 
jKnclude  <io.h> 
iiaclude  <fcntl.h> 

#iiiclude  <edit.h> 
fiaclude  <pkt_if.h> 


static  int  file_rtatus,  file_handle_ni  »  -1; 
//  static  bt  iile_liandle_tx  «  -1; 
static  FILE  '*file_rx  “  NULL; 

fdefine  HLE  1S_DEVICE  0x0080 

fdeEne  HLE~NOT  EOF  0x0040 

fdefiiie  FILE~1S  RAW  0x0020 
fdefine  HLE  SCT  BITS  OxOOfT 


int  tans  jxnt  initO 

{ 

cfaar  ^filename; 


filename  «  edit_text(”Enter  TANS  file/device: ",  ”coml”}; 


return  tans_port_init_byaaine(filename); 


int  tans_port_init_bynaiiie(char  "filename) 


if  ((file  handle  rx  «  open(filename.  O  RDWR|0  HNARY))  <  0) 
{  "  ■ 

printf("Can't  open  file/device  XsNn”,  filoiame); 
return  NO; 

} 
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*  If  input  file  is  a  device,  place  that  device  in  *niw*  mode.  Otherwise 

*  reopen  using  buffered  I/O. 

■*/ 

file_status  >  ioctl(fUe_handle_rx,  0.  0,0); 

if  (file  status  &  FILE  IS  DEVICE) 

{ 

fUe_status  -  (file.status  &  F1LE_SET_B1TS)  |  P1LEJS_RAW  j  FILE_NOT_EOF; 
ioctF(file_handIe_rx,  1,  file_status,0); 

//  file  h^le_tx  B  file  haodle_rx; 

} 

else 

{ 

if  ((file  rx  =  fdopen(file  handle_rx,  "rb"))  =  =  NULL) 

{ 

close(file_handle_rx); 

printfCCan't  open  %s,  out  of  memoiyVn”,  filename); 
return  NO; 

} 

//  filename  —  edit_text('‘Enter  TANS  output  file:*,  filename); 

//  if  ((file  handle  tx  =  open(filenanie,  O  RDWRjO  BINARY  |0  GREAT,  0666))  <  0) 
//  {  ■  ■ 

//  printf(*Can’t  create  file  %s\n*,  filename); 

//  close(file_handle_rx); 

//  return  NO; 

H) 


return  YES; 


int  tans_port  stopO 

{ 

/* - 

*  If  input  file  is  a  device,  place  that  device  back  in  "cooked”  mode. 
♦/ 

if  (file  status  &.  FILE  IS_DEVICE) 

{ 

fi]e_status  —  FILE_IS_RAW; 

ioctl(file_handle_rx,  1,  file_rtatus,0); 
cIose(file  handle  rx); 

} 

else 

{ 

fclose(file_rx); 

//  ciose(file_handIe_tx); 
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} 

niuni  YES; 

) 


*  DOS  has  a  bug  regardiag  devicua  in  law  mode,  this  piece  of  code 

*  fixea  the  error  caused  by  the  bug.  The  bug  occurs  undn  these  conditions: 

*  -  You  are  reading  from  a  device  in  raw  mode. 

*  '  The  memmy  you  are  reading  into  just  happens  to  £dl  on  a  paragraph 

*  boundaiy  (i.e.  die  address  is  divisible  by  16). 

*  *  The  d^ce  driver  doesn’t  have  any  bytes  ready  for  you. 

* 

*  Under  these  conditions,  DOS  will  erroneously  mark  your  file  with  an  EOF 

*  flag,  after  which  readQ  will  always  fiul,  even  if  die  device  has  some  bytes 

*  ready.  This  kludge  marks  the  file  as  not-EOF. 

*  - */ 

static  void  fix  doe  eof  bug(void  ^location) 

{ 

if  (((uahort)locatiao  &  15)  0  &&  file  status  St  FILE  IS  DEVICE) 

{ 

file_status  I  *  FILE_NOT_EOF; 
ioctl(file  himdle  rx,  1,  file  status,0); 

> 

} 


int  tans_port  jgetbQ 

{ 

/* - 

*/ 

if  (file_statu8  St  HLE  IS  DEVICE) 

i 

tAyte  work; 

if  (read(fi)e_handle_rx,  dcwotk,  1)  >  0)  return  work; 

fix_doe_eof_bug(&work); 

return  *1; 

) 

else  return  getc(file_rx); 


* - */ 

#ifdefNOT_YET 

int  tansjport  read(ubyte  *where,  int  bytes) 

{ 
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if  ((hyte$  »  icad(fiJe_haiidle_rx,  wbeie,  bytes))  <  ^  0)  fix_do8_eof_bug(where); 
fetuin  bytes; 

} 

#eodif  NOT_YET 


*  I  will  not  write  to 

•  - */ 

int  tansjport_8endb(ubyte  vtlue) 

{ 

//  return  (write(file_hsndle  tx,  Avslue,  1)  <  =  0  ?  NO  :  YES); 

} 
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jKoclude  <itdio.b> 

Moclude  <edit.b> 
jKoclude  <coni_port.b> 
finclude  <pkt_if.b> 


* _ 

static  iot  port_id; 


•*/ 


■*! 


♦- - */ 

int  taiis_port  initO 

{ 

static  cbar  msgQ  —  'Enter  TANS  port  id  (RS422  coin3  or  coid4)  > 

ushort  rx_8ize  —  2048; 
ushort  tx_size  »  512; 

/* - 

*! 

port_id  =  edit_mteger(insg,  3); 
if  (port_id  =  5=  0)  return  YES; 

I*  rx_size  =  edit_integer("  Enter  rx  size  ",  512);  */ 

I*  rx_size  *  edit_tnteger(''  Enter  tx  size  *,  128);  */ 

if  (com_port  start(port  id,  rx_size,  tx_size)  =  *  NO) 

printf(”Can’t  start  port  %d\n",  portjd); 
port_id  =  0; 
return  NO; 

} 

com_port_set(port_id,  9600L,  COM_PORT_par_odd,  COM_PORT_stop_l); 
return  YES; 


/*= 


* - ♦/ 

int  tans_port  stopQ 

{ 

if  (portjd)  coinjx>rt_stop(portJd); 
return  YES; 
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} 


* - *! 

int  tans  j>ort_getbO 

{ 

retuni  (port  id  ?  comjx>rt_get(poit_id)  :  -1); 

) 


* - */ 

int  tans_port_sendb(ubyte  value) 

{ 

return  (portjd  ?  com_port_put(port_id,  value)  :  YES); 

} 


#ifdef  NOT_YET 

int  tans_port  read(ubyte  'hvhere,  int  bytes) 

{ 

return  comjport  read(port  id,  where,  bytes); 

} 

((fendif  NOT_YET 
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iKociude  <packet.h> 
^include  <{dct_if.h> 
^include  <taiis_pkt.h> 
finclude  <swap.h> 
#uiclude  <tiines.h> 


*/ 


*  The  orbiter-gps  packet  is  actually  owned  by  orb_port_processO 

*  - */ 

extern  Orb _aps_packet  orbiter_gp8_packet; 


* - */ 

static  struct 

{ 

Tansj>acket  packet; 
struct 
{ 

int  got; 
double  prev; 

Tans_pkt_21_41  pkt; 

Time _gps  gps; 

Tiine_utc  utc; 

}  time; 

struct  {  int  got;  Taiis_pkt_43  pkt;  }  vel; 
struct  {  int  got;  Tans_pkt_83  pkt;  }  pos; 

}  my; 

static  int 

proce3SjMicket_41  (void), 
process_packet_43(void), 
process jMicket_83(void), 
ciieck_packets(void); 


Returns: 

*  0  Nothing  available 

*  >0  Packet  type 

■* - */ 

int  tans_port_processO 

{ 

int  rc; 

/* - 
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*  Get  all  the  evailable  packets  until  I  find  something  I  can  use. 

*/ 

for  (rc  »  NO;  rc  *  =  NO; ) 

{ 

if  (tansj>acket_recv(&niy.packet)  *  —  NO 
1 1  my.packet.state  !«  TANS  state  packrt  ok)  break; 

switch  (my.packet.raw[l]) 

{ 

case  0x41:  rc  s  process_packet_410;  break; 
case  0x43:  rc  =  process_packet_430;  break; 
case  0x83:  rc  —  process_packet_830;  break; 

default:  rc  =  NO; 

} 

if  (rc)  rc  =  check_packetsO; 

} 

return  rc; 

} 

* - */ 

static  int  check_j:scketsO 

{ 

*  Week  rollover  is  not  handled  perfectly,  some  data  may  be  tossed  out. 

*1 

if  (my.time.got  StSt  my.pos.got  &&  my.vel.got) 

{ 

if  (my.vel.pkt.sol_tiine  >  my.pos.pkt.sol_time)  my.pos.got  =  NO; 

else  if  (my.vel.pkt.sol_time  <  my.pos.pkt.sol_time)  my.vel.got  =  NO; 
else  if  (my.vel.pkt.8oi_time  <  =  0.0)  my.pos.got  =  my.vel.got  »  NO; 
else 
{ 

if  (my.vel.pkt.sol_time  <  my.time.prev)  my.time.pkt.week+-i'; 
my.time.prev  =  my.vel.pkt.sol_time; 

my.time.gps.secs  =  my.vel.pkt.sol_time; 
my.time.gps.week  =  my.time.pkt.week; 

time _gps_to_utc(&my.time.gps,  my.time.pkt.gps_utc_offset,  &my.time.utc); 

orbiter _gps_packet.gps_vector.pos  =  my.pos.pkt.pos; 
orbiter_gps_packet.gps_vector.vel.x  =  my.vel.pkt.vel.x; 
orbiter_gps_packet.gps_vector.vel.y  =  my.vel.pkt.vel.y; 
otbiter_gps_packet.gps_vector.vel.z  »  my.vel.pkt.vei.z; 
orbiter _gps_packet.gps_vector.time  =  my.tinie.idc.secs; 
my.pos.got  =  my.vel.got  »=  NO; 
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return  orbiter_ia’s_packet. header. type  =  PiCr_gps; 

} 

} 

return  NO; 


* - */ 

static  int  processjpacket  410 

{ 

int  size; 

Tans_pkt_21_41  '''packet; 

*/ 

size  =  my.packet.cooked_size  -  sizeof(Tansjpkt_head)  -  sizeof(Taiis_pkt_tail); 
if  (size  !=  sizeof(Tans_pkt_21_41))  return  NO; 

packet  =  (Tans_pkt_21_41  "'Xmy.  packet,  cooked  +  sizeof(Tans_pkt_head)); 

*/ 

swap_float(&packet-  >  secs_of_week,  &packet-  >  secs_of_week); 
swap_fIoat(&packet*  >  gps_utc_offset,  &packet-  >  gps_utc_offset); 
swap_short(&packet-  >  week ,  &packet-  >  week) ; 

my.time.prev  =  0.0; 
my.time.pkt  =  "'packet; 
my.time.got  =  YES; 
return  YES; 


/"■ 


* - ♦/ 

static  int  processjMcket  430 

{ 

int  size; 

Tans_pkt_43  "'packet; 

*1 

size  =  my.packet.cooked_size  -  sizeof(Tans_pkt_head)  -  sizeof(Tans_pkt_tail); 
if  (size  !  =  sizeof(Tans_pkt_43))  return  NO; 

packet  =  (Tans_pkt_43  "')(iny.packet.cooked  +  sizeof(Tans_pkt_head)); 
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/* - 

*! 

sw^>_float(&packet->sol_time,  &packet->sol_tuiie); 

>  vel .  X,  &packet-  >  vel .  x); 
twap_float(Jl4Mu:ket->  vel.y,  Apacket-  > vel.y); 
swap_float(A^Mu;ket->vel.z,  &packet->vel.z); 

my.vel.pkt  »  Vpacket; 
my.vel.got  *  YES; 
return  YES; 


* _ ♦/ 

static  int  process_packet_830 

{ 

int  size; 

Tans_pkt_83  '^'packet; 

/* - 

*1 

size  =  niy.packet.cooked_size  •  sizeof(Tans_pkt_head)  •  sizeof(Tans_pkt_tail); 
if  (size  !  =  sizeof(Tans_pkt_83))  return  NO; 

packet  =  (Tans_pkt_83  '*')(niy.packet.cooked  +  sizeof(Tans_pkt_head)); 

*/ 

swap_float(&packet-  >  sol_time,  &packet-  >  sol_time); 
swap_double(&packet-  >  pos.x,  &packet-  >  pos.x); 
swap_double(&packet-  >  pos.y ,  &packet-  >  pos.y); 
swap_double(&packet-  >  pos.z,  &packet-  >  pos.z); 

my.pos.pkt  =»  ^packet; 
my.pos.got  s  YES; 
return  YES; 
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Coiiipute_a  matrix  calculates  the  *A’  matrix 
Input  arguments  are  • 

tinM  ss  time  of  day  in  seccmds  past  midnight 
Return  arguments  are  • 

a  »  4x4  matrix  with  the  zero  elements  unused; 

die  1,2,&3  row/column  elements  are  the  'A'  transformation 

matrix  elements. 

Global  variables  are  • 
q>och_.input 

'conq>ute_a_matrix’  is  called  by  ’get_inertial_to_wgs84_matrix’ 
'compute_a_matrix’  calls  'get_rotation_angles’ 


#include  <matb.h> 
jfinclude  *mpin50.h* 

#include  ’iers.h” 

void  compute_a_oaatrix(timeJd_inidiught,lERS,a) 
double  time,jd_inidnight,a[4][4]  ; 
struct  lERS  DATA  '"lERS  ; 

{ 

double  jd,  x,  y,  utl_minus_utc,  sin_x,  cos_x,  sin_y,  cos_y  ; 

jd  3=  jd_inidnight  +  time/86400.0  ; 
get_rotation_angies(jd,  lERS,  Stx,  &y,  &utl_iDinus_utc)  ; 

8m_x  =  sin(x)  ;  cos_x  =  cos(x)  ; 
sin_y  =  sin(y)  ;  cos__y  =  cos(y)  ; 

a[l][l]  =  cos_x  ;  a[l][2]  =  sin_x*sm_y  ;  a[l][3]  =  sin_x*cos_j'  ; 
a[21[li  =  0.0  ;  a[2][2]  =  cos_y  ;  a[2K3]  =  -  8in_y  ; 

«[3][1]  =  -sin_x  ;  a[3][2]  =  cos_x*8in_y  ;  8[3][3]  =  cos_x*cos_y  ; 


} 
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This  is  the  function  'bgprc^’. 

Input  arguments  are  • 

tinie_tota]  b  utc  time  in  secs  from  start  of  year 
pos  B  array  of  position  vector  in  MSO 
pos[0]  B  not  used 
po8[l]  B  X  (km) 
pos(2]  =  y  (km) 
pos[3]  B  z  (km) 

vel  B  array  of  velocity  vector 

vel[0]  B  not  used 
vel[l]  B  vx  (km/s) 
vel[2]  =  vy  (km/s) 
vel[3]  =  vz  (km/s) 

delta_t  B  desired  time  of  propogation 
st^  B  integrator  step  size 

The  following  inputs  are  from  the  daily/weekly 
US  Naval  Obsevatoiy  Observations 

solar_fIux  b  daily  F10.7  solar  flux 

mean_solar_flux  b  average  F10.7  for  previous  162  days 

geomagnetic_index_^  b  geomagnetic  activity  index  6.7  hours  prior 

to  measurement 

Return  arguments  are  - 

posf  =  array  of  position  vector  in  M50 
posf[0]  B  not  used 
posf[l]  =  X  (km) 
posf[2]  B  y  (km) 
posfI3]  B  z  (km) 

velf  B  array  of  velocity  vector 
veif[0]  B  not  used 
velf[l]  B  vx  (km/s) 
velf[2]  B  vy  (km/s) 
velf[3]  B  vz  (km/s) 

It  does  not  return  the  new  time.  You  must  keep  track  of  that  from  the 

calling  program. 

#include  <stdio.h> 

iftnclude  <orbmechl.h> 

^include  ”rnpmSO.h” 

#mclude  "iers.h* 
fKnclude  ”util.h” 


static  struct  IERS_DATA  far  lERS; 
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•Utic  int  fim_tioie  »  1; 
static  int  my^year  «  1993; 


* - */ 

void  bgprop_year(int  year)  {  0iy_year  =  year;  } 


int  bgpft^_initO 

{ 

HLE  *in_file; 
int  i; 

See  lERS  data  file  in  iers.dat  for  explaination. 

*1 

if  (first_tiine  ==  0)  return  1; 

if  ((in_file  =  fopenf'iers.dat'/r"))  ==  NULL) 

{ 

putsCERROR;  Can’t  find  IERS.DAT”); 
return  0; 

} 

for  (i=0;  i<ss89;  i++) 

( 

fscanfCin  file.”%lf  %lf  %lf  %lf\n”. 

&IERs7injd[i],&IERS.x[i],&IERS.y[il,&IERS.t[i]); 

} 

fclose(in_file); 

/* - 

*1 

set_jacchia_dataO; 

fiiid_tinie  =  0; 
return  1; 

} 

♦ - */ 

static  void  make  mp(double  time  total,  double  'Secs_of_day,  EPOCH  REF  "‘epoch,  RNP  "‘mSO) 

{  ■  " 

double  days;  //  Total  time  expressed  as  days 

double  time;  //  Seconds  in  currrat  day 

RNP_REFERENCE  reference  =  AT_MIDNIGHT; 

/* - 
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*/ 

time  »  time_tota]  -  (loogXdeyt  *  time_toUl/86400.0)  *  86400.0; 
•iecs_of_d»y  »  time; 

epoch- >time_scale  ^  GMT; 

epoch- >julMn_date  ■  jiilMii_date(my_year,  1,  1,  0,  0,  0.0)  +  days; 

epoch- >julian_date_midiiight  «  epoch- >julian_date  •  time/86400.0; 

epoch- >delta_time_tdt_utl  = 

epoch- >delta_time_tdt_utl_midiught  =  60.9377447714656029; 
compute_mp(&refereiice,  epoch,  mSO); 

} 


"■  Note: 

Pos_vec  and  posf_vec  may  point  to  the  same  Vector,  i.e.  you  can  use  the 
Vector  for  input  and  output.  This  also  holds  true  for  vel_vec/velf_vec. 

* - */ 

void  bgprop(doubIe  time_tota].  Vector  '*'pos_vec. 

Vector  '*Vel_vec,  Perturbations  *P,  double  delta_t,  double  step. 
Vector  *posf  vec.  Vector  *velf  vec) 

{ 

double  pos{4],  velt4],  posfI4],  velf[4]; 
double  time,  timef,  rfin; 

EPOCH_REF  epoch; 

RNP  m50; 

/* - 

*  See  lERS  data  file  in  iers.dat  for  explaination. 

if  (first_time)  bgprop_init0; 

//  Must  now  be  called  by  user  tc  ' .ze  Pert,  structure  with  Grav  info. 

//  instantiate _go^t(l,  P); 

/* - 

*/ 

pos[l]  ss  pos_vec->x;  pos[2]  =  pos_vec->y;  pos[3]  =  pos_vec->z; 
vel[l]  —  vel_vec->x;  vel[2]  =  vel_vec->y;  vel[3]  =  vel_vec->z; 

/♦ - 

*  Time  is:  seconds  in  current  day. 

*1 

iiiake_mp(time_total,  &time,  &epoch,  &in50); 

timef  =  time  +  delta_t;  /*  time  after  propMigation  */ 
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cowelKtime,  poa,  vel,  Aepoch,  P,  JlcIERS,  atep.  timef,  poaf.  vdf,  Ariin); 

/* - — - - - 

*/ 

poaf_vec->x  »  poafll];  poaf_vcc->y  ■  poaf[2];  poaf_vec->i  ■  poaf[3]: 
velf_vec->x  »  vdf[l];  velf_vec->y  »  velf[2];  vW_vec->z  *  vdifS]; 


/■»* 


*  This  function  tnuisfonns  to  and  from  MSO  and  WGS84  eooida  depending  on  the 

*  value  of  ’direction’.  If  direction  =  0,  avin  is  assumed  to  be  in  and 

*  svout  is  the  same  vector  in  WGS84.  If  direction  not  0,  the  transition  is 

*  from  WGS84  to  MSO.  ALL  TIMES  ARE  ASSUMED  TO  BE  MSO  TYPE. 
- ♦/ 

void  mS0_wgs84_mS0(State_vector  '*’svin,  State_vector  *svout, 

int  direction.  State  vector_trBnsform  *svt,  int  vel_is_ecef) 

{ 

double  posin[4],  velin[4],  posout[4].  veIout[4].  MSO  to  WGS84[4][4]; 
double  WGS84_to_MS0(4]{4],  time; 
double  omega[4],  omegaXr(4]; 
int  ij; 

EPOCH  REF  epoch; 

RNP  "  mSO; 

*/ 

if  (first_time)  bgprop_init(); 

make_mp(svin->time,  &time,  dcepoch,  &mS0); 

get_inertial_to_wgs84_matrix(time,  q>ocb.julian  date  midnight,  &mS0, 

EARTH_OMEGA,  ddERS,  MS0_to_WGS84); 


if  (svt  !*  NULL) 

{ 

svt->time  =  svin->time; 

♦((Vector  *)&svt->matrix[0](0])  =  ♦((Vector  ♦I&MSO  to_WGS84[l][l]); 
♦((Vector  ♦)&svt->matrix[ll[0])  «  ♦((Vector  *)&MS0jo_WGS84[2][l]); 
♦((Vector  ♦)&svt->matrix(2][01)  =  ♦((Vector  ♦)&MS0~to  WGS84[3][1)): 

} 


/♦ - 

♦/ 

posin[l]  s  svin->pos.x; 
posin[2]  =  svin->pos.y; 
posin[3]  =  svin->pos.z; 
velin[l]  =  svin->vel.x; 
velin[2]  =  svin->vel.y; 


bgprop.c 


bgprop.c 


veliD[3]  «  ■viii->vel.z; 

if  (vel  it  ecef) 

{ 

omecaCl]  -  EARTH  OMEGA  *  M50  to  WGS84[3][I]; 
oniegi(2]  *  EARTH'oMEGA  MS0~to~WGSS4(3][2]; 
oiiieg«[3]  «  EARTH'oMEGA  *  M50~to  WGS84{3}[3]; 

} 

/* - 

*! 

if  (direction  »  =  0)  //  M50  to  WGS84 

{ 

if  (vel_is  eceO 

{ 

crossComega,  potin,  omegtXr); 

velin[l]  •=  oaiegtXr[l];  velui[2]  -=  omegaXr[2];  velin[3]  •=  otnegaXr[3]; 

} 

matrix_x_vector(MS0_to_WGS84,  posin,  posout); 
matrix  x_vector(MS0  to_WGS84,  velm,  veiout); 

} 

else  //  WGS84  to  MSO 

{ 

matrixTranspose_x_vector(MS0_to_WGS84,  posin,  posout); 
matrixTran^K)se_x_^vector(M50_to_WGS84,  velin,  veiout); 
if  (vel  is  ecef) 

{ 

cross(omega,  posout,  omegaXr); 

velout[l]  +=  omegaXr[l];  velout[2]  +=  ooiegaXr[2];  velout[3]  +*  oinegaXr[3]; 

} 


svout->pos.x  «  posout[l]; 
svout->pos.y  s  posout[2]; 
svout->pos.z  =  posout[3]; 
svout->veI.x  =  veIout[l]; 
svout->vd.y  s  velout[2]; 
svout->vel.z  —  velout(3]; 
svout->time  —  svin->tiine; 
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This  is  the  function  ’cowelP. 

Input  arguments  are  • 

time  s  initial  time  m  seconds 
pos  s  array  of  initial  pontion  vector 

pos(0]  »  not  used 
pos[l]  s  X  (km) 
pos[2]  *  y  (km) 
pos(3]  *»  z  (km) 

vel  a:  array  of  initial  velocity  vector 

vel[0]  «  not  used 
vel[l]  =  vx  (km/s) 
vel[2]  s  vy  (km/s) 
vel[3]  =  vz  (km/s) 
step  =  integrator  stqi  size  in  seconds 
timef=  target  time  of  propogation 
epoch  s  Pointer  to  EPOCH_REF 
mSO  =  Pointer  to  M50  RNP  Matrix 
P  —  Pointer  to  Perturbations  Structure 

lERS  s  Pointer  to  lERS  data  file 
Return  arguments  are  • 

posf  s  array  of  propogated  position  vector 
posf[0]  =  not  used 
posf[II  =  X  (km) 
posfl21  =  y  (km) 
posf[3]  —  z  (km) 

velf  —  array  of  propogated  velocity  vector 
velf[0]  —  not  used 
velf[l]  =  vx  (km/s) 
velf[2]  =  vy  (km/s) 
velf[3]  =  vz  (km/s) 

rfin  =  magnitude  of  position  vector  at  destination 

'Coweir  is  called  by  ’bgprop’. 

'Coweir  calls  the  Runge-Kutta  integrator. 

#include  <stdio.h> 

iKnclude  <oibmechl.h> 
iKnclude  *iers.h” 
finclude  "util.h” 
jKnclude  "mpmSO.h'' 


void  coweil(double  time,  double  pos[4],  double  vel[4],  EPOCH_REF  '"epoch, 

RNP  '"mSO,  Perturbations  *P,  struct  IERS_DATA  *I£RS,  double  st^, 
double  timef,  double  posf[4],  double  velf[4],  double  riin[l]) 

{ 

double  lnitial_State[8],Integrated_State[8],time^step,time_now  ; 
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This  is  the  function  ’coweU*. 

Input  srsuments  are  - 

time  K  initial  time  in  seconds 
pos  B  array  of  initial  position  vector 

po6[0]  B  not  used 
pos{l]  B  X  (km) 
p08l2]  B  y  (km) 
pos[3]  B  z  (km) 

vel  B  array  of  initial  velocity  vector 

vel[0]  B  not  used 
vel[l]  =  vx  (km/s) 
vel[2]  =  vy  (km/s) 
vel[3]  B  vz  (km/s) 
step  B  integrator  stq>  size  in  seconds 
timefB  target  time  of  propogation 
epoch  B  Pointer  to  EPOCH_REF 

B  Pointer  to  M30  RNP  Matrix 
P  B  Pomter  to  Perturbations  Structure 

lERS  B  Pointer  to  lERS  data  file 
Return  arguments  are  • 

posf  B  array  of  propogated  position  vector 
posf[0]  B  not  used 
posf[l]  B  X  (km) 
posf[2]  =  y  (km) 
posf[3]  B  z  (km) 

velf  B  array  of  propogated  velocity  vector 
velf[0]  B  not  used 
velf[l]  B  vx  (km/s) 
velfI2]  =  vy  (km/s) 
velf[3]  B  vz  (km/s) 

rfin  B  magnitude  of  position  vector  at  destination 


’Cowell  ’  is  called  by  ’bgprop’. 

'Coweir  calls  the  Runge-Kutta  mtegrator. 

#include  <stdio.h> 

#include  <orbmecbl.h> 

#include  "iers.h* 
iKnclude  "utiLh” 
iNnclude  "mpmSO.h” 

void  cowell(doubie  time,  double  pos(4],  double  vel[4],  EPOCH_REF  *q>och, 

RNP  *m50.  Perturbations  *P,  struct  IERS_DATA  *IERS,  double  step, 
double  timef,  double  posf[4],  double  velf[4],  double  rfin[l]) 

{ 

double  Initial_State[8],IntegnUed_S(ate[8],time_step,time_now  ; 
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int  done  »  FALSE  ; 

lnitMl_Sute[l]  »  pos{l]  ; 
liutul_State(2]  »  pos[2]  ; 

Initial  State[3]  »  pos[3]  ; 

Iiutial~State(4]  «  vel[l]  ; 

Initial  State[S]  »  vel[2]  ; 

IniUal~State[6]  «  vel[3]  ; 

Initial_State[7]  »  magnitude(pos)  ; 

tinie_now  ^  time  ; 
tinie_step  =  step  ; 

wtiile(done  ss  FALSE) 

{ 

if((time_now+time_step)  >  timeO 

{ 

time_step  =  timef  -  time_now  ; 
done  s  TRUE  ; 

} 

Runge_Kutta_4(time_now,  lnitial_State,  epoch- >julian_date_midnight, 
mSO,  P,  lERS,  time_step,  Integrated_State); 

time_now  =  tune_now  +  time_step:  /^update  time  */ 

lnitial_State[l]  —  lntegrated_State[l];  /'^update  state  *! 
lnitial_State[2]  =  Integrated_State[2]; 
lnitial_State[3]  =  Integrated_State[3]; 

Initial_State[4]  =  Integrated_State[4]; 

Initial_State[5]  =  lntegrated_State[S]; 

Initial_State[6]  =  Integnted_State[6]; 

Initial_State[7]  =  Integrated_State[7]; 

} 

posf[l]  =  Initial_State[l];  /’^final  state  *! 

posf[2]  =  Initial_State[2]; 
posf[3]  —  Initial_State[3]; 

velf[l]  =  lnitial_State[4]; 
velf[2]  =  Initial_State[5]; 
ve]f[3]  =  Initial_State[6]; 

riin[0]  —  Initial_State[7]; 
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This  is  the  Derivatives  fiuictioa.  It  is  called  by  the  btegrator  and 
defines  the  first  derivatives  of  the  state  vector. 

Input  arguments  are  - 

time  »  state  vector  time  m  seconds 
xz(8]  s  state  array  consi^g  of  the  following  elements  - 
xz[0]  «  not  used 
X2[IJ  ^  position  in  x  (km) 
xz[2]  ■■  position  in  y  (km) 
xz{3]  position  in  z  (km) 
xz[4]  «  velocity  in  x  (km/s) 
xz(5]  s  velocity  in  y  (km/s) 
xz(6]  «  velocity  in  z  (km/s) 
xz[7]  -  magnitude  of  position  vector  (km) 
Return  argummts  are- 

f[8]  s  derivatives  of  input  ^ate  vector  elements 


’Derivatives’  is  called  by  Runge-Kutta 
'Derivatives'  calls  - 

get_inertia]_to_wgs84_matrix 

matrix_x_vector 

gotpot 

matrixTranspose_x_vector 

jacchia_density 

magnitude 

*^i^*>Hli*iti4,iH,^,^^4>4,^,l,01i*^i*^iiti04‘******‘¥********'l'*********************************/ 

finclude  <stdio.h> 

#include  <orbmechl.h> 
jfinclude  "iers.h’ 

#include  "mpmSO.h" 

#inciude  "util.h” 

void  Derivatives(m50,  P,  lERS,  jd_midnigbt,  time,  xz,  f) 
double  time,xz[8],f[8],jd_midnight  ; 

Perturbations  "'P ; 

struct  lERS  DATA  -^UERS  ; 

RNP  *m5b  ; 

{ 

double  jacchia_densityO; 

double  dmsity,  velocity_mag,  relative_velocity[4],  temp  ; 

double  position_lnertial[4],  velocity_inertial[4],  position_wgs84[4]  ; 

double  g[4],  g_wgs84[4],  pot,  drag_acceleration[4]  ; 

double  M50_to_WGS84[4][4];  /*  tranformation  matrix  *! 

double  jd;  !*  Julian  date  *! 

int  i;  /•  loop  counter  *! 

int  total^gravity  =  1; 
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for(i=°l  ;  i<  *3  ;  i++) 

{ 

position_iDertial[i]sxz[i]  ; 
veIocity_iiicrtUI[i]=X2ti+3]  ; 
drag  acceleration[i]s0.0  ; 
g(i]=0.0  ; 
potssO.O  ; 

} 


/* - // 

//  Get  Gravity  Acceleration  // 


I* 

*  Rotate  Position  from  MSO  to  WGS84 
Compute  Gravity  Perturtiations 
Rotate  gravity  vector  t>ack  to  MSO  for  use  in  computing 
derivatives. 

*1 

get_inertial_to_wg884_naatrix(time,jd_midnight,mS0, 

P-  >  Gravity  .GMD.planet_omega,IERS,M50_to_WGS84): 
matrix_x_vector(M50_to_WGS84,  posiCon_inertial,  position_wgs84)  ; 
gotpot(P,  total_gravity,  position_wgs84,  xz[7],  g_wgs84,  &pot)  ; 
matrixTranspose_x_vector(M50_to_WGS84,  g_wgs84,  g) ; 

//  Get  Drag  Acceleration  // 

if  (P->Drag.mode  ==  ON)  { 
jd  =  jd_midnight+time/86400; 

density  =  jacchia_density(position_inertial,  /■"  (kg/m'‘3)  */ 
position_wgs84,  xz[7],  jd, 

P-  >  Drag.solar_fIux,P-  >  Drag.mean_solar_flux, 
P->Drag.geomagnetic_index_ap)  *  1000.0; 

reIative_velocity[l]  =  velocity_mertia][l]  + 
position_inertial[2] 
P->Gravity.GMD.planet_omega  ; 
relative_velocity[2]  =  veIocity_inertial[2]  - 
position_inertial[l]  "■ 

P-> Gravity. GMD.planet_omega  ; 
relative_velocily[3]  =  velocity_inertial[3]  ; 

veiocity_mag  —  magnitude(relative_velocity)  ; 
temp  =  -0.5'*'density*velocity_mag’*'1000.0  /  P- >  Drag.bal]istic_number 
for(i=l  ;  i<=3  ;  i++) 

{ 

drag_acceleration[i]  =  temp  *  reIative_veIocity[i]  ;  /*  (km/s'‘2)  */ 
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} 


} 


/* - // 

//  Compute  Derivatives  // 

// - ♦/ 

foKi^l  ;  i<=3  ;  i++) 

{ 

fli]  =  xz(i+31  ; 

fli+3]  =  g[i]  +  drag_acceleration[i]; 

} 

fI7]  =  (X2[1]*X2I4]  +  x2[2]*xz[5]  +  xz[3]*x46])/xzt7] 
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~  +  + 

—  COMPONENT  NAME: 

—  GEM_9_model_daU 

-ABSTRACT: 

—  This  package  provides  the  GEM  9  normalized  coefficients  which  are 

—  taken  from  the  reference.  This  package  also  provides  values  of  the 

—  earth’s  gravitational  constant,  GM,  earth’s  equatorial  radius,  ae, 

—  and  the  earth’s  rotation  rate,  omega. 

—  AUTHOR: 

—  Robert  G.  Gottlieb 

—  CREATION  DATE: 

—  25  January  1989 

—  C  version  created  25  January  1990 

—  PROJECT/PROGRAM: 

—  McDonnell  Douglas  Space  Systems  Company 

—  Engineering  Services 

—  REFERENCES: 

—  These  constants  are  given  in  Table  3  of  "Gravity  Model  Improvements 

—  Using  Geos  3  (GEM  9  and  GEM  10)"  by  F.  Lerch,  S.  Klosko,  R.  Laubscher, 

—  and  C.  Wagner,  Journal  of  Geophysical  Research,  Vol.  84,  NO.  B8, 

—  July  30,  1979. 


—  KEYWORDS: 

—  gravity  model 

—  gravitational  potential 

—  gravitational  acceleration 
--  central  force 

—  gravitational  perturbations 

—  nonspherical  earth 

—  IMPLEMENTATION  DEPENDENOES: 

—  none 

—  +  + 

★ _ */ 

^include  <stdio.h> 

#include  <math.h> 

^include  "util.h" 


static  double 


- */ 
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fcrcUlJ  »{0.0}, 

far  c2[3]  >  {-484.16SSS,-0.00021,  2.43400  }. 

hr  c3[4]  =  {  0.9S848,  2.02826,  0.89198,  0.70256  }. 

far  c4[5]  =  {  0.54154,-0.53287,  0.35259,  0.98849,^.19661  }, 

ftr  c5[6]  =  {  0.06844,-0.04910,  0.64975,-0.47030,-0.29049,  0.16123}, 

«»r  c6[7]  =  {-0.15121,-0.07543,  0.04813,  0.05910,-0.10458,-0.25597, 
0.00188}, 

far  c7[8]  =  {  0.09331,  0.26724,  0.32786,  0.23987,-0.28553,  0.01667, 
-0.36330,-0.00924}, 

far  c8[9]  =  {  0.05095,  0.02483,  0.07315,-0.00992,-0.24624,-0.01251, 
-0.07471,  0.06778,-0.12123}, 

far  c9[10]  =  {  0.02733,  0.16065,  0.02445,-0.17360,-0.01134,  0.00490, 
0.03737,-0.10449,  0.19418,-0.05810}, 

farcl0[ll]  =  (0.05284,  0.08238,-0.08429,-0.0207l,-0.10099,-0.06216, 
-0.03888,-0.00022,  0.03989,  0.12430,  0.10563}, 

far  cl  1(12]  =  {-0.04862,  0.00023,  0.03947,-0.02883,-0.04503,  0.04545, 
0.00256,  0.01076,  0.00878,-0.02893,-0.06709,  0.04047}, 

far  cl2[13]  =  {  0.03794,-0.06304,  0.00390,  0.06412,-0.07375,  0.04569, 
0.00273,-0.01282,-0.02430,  0.04154,  0.00028,  0.01603, 
-0.00764}, 

farcl3[14]  =  {0.04408,-0.03419,  0.02214,-0.04313,-0.02511,0.06892, 
-0.03329,-0.00490,-0.02066,  0.02678,  0.03154,-0.04459, 
-0.03230,-0.06009}, 

far  014(15]  =  {-0.02111,-0.01764,-0.03632,  0.0127l,-0.01831,  0.01940, 
-0.00684,  0.01804,-0.04572,  0.03880,  0.05791,  0.01920, 
0.00835,  0.02803,-0.05119}, 

far  cl5(16]  =  {  0.00136,-0.01848,  0.00864,  0.02086,-0.04391,-0.01243, 
0.02539,  0.06506,-0.01726,  0.01303,  0.02896,  0.00047, 
-0.03347,-0.02282,  0.00392,-0.02108}, 

far  cl6(17]  =  {-0.00846,  0.02543,-0.00524,-0.00379,  0.03351,-0.01371, 
-0.00697,  0.00412,-0.01005,-0.01885,  0.01564,  0.02186, 
0.01770,  0.01223,-0.01943,-0.01320,-0.02546}, 

farcl7(18]  =  {0.01619,-0.00353,-0.00985,-0.00821,0.00095,-0.02428, 
-0.00165,  0.01583,  0.01245,-0.01075,  0.01069,-0.04212, 
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0.03148,  0.01471,-0.01389,  0.00159,-0.02368,-0.01299}, 

cl8[19]  -  {  0.01117,  0.00227,  0.00649,-0.00006,  0.02206,  0.01637, 
0.01215,-0.00308,  0.00676,-0.02487,-0.00246,-0.00447, 
-0.03891,-0.01200,-0.00851,-0.05461,  0.00824,  0.01983, 
0.00198}, 

far  cl9[20]  =  {  0.00133,-0.03465,  0.00877,  0.00058,-0.00396,-0.00436, 
0.00006,-0.00866,  0.00813,  0.00493,-0.01507,-0.00497, 
-0.00752,-0.01235,-0.00552,-0.02174,-0.03536,  0.02971, 
0.03539,  0.00865}, 

far  c20[21]  =  {  0.02562,  0.00129,-0.00395,-0.01561,  0.00072,  0.00153, 
-0.00620,-0.01072,-0.00306,  0.00534,-0.01150,  0.01075, 
0.00911,  0.02319,  0.01232,-0.02311,-0.01434,0.01435. 
0.00275,  0.01586,0.00510}, 

far  c21[22]  =  {0.00128,0.01238,  0.01467,  0.00407,  0.00313,  0.0, 

0.0,  0.0,  0.0,  0.00467,0.00048,0.00506. 

0.00330.0.01641,  0.01955,  0.01066,  0.00027,0.00288, 
0.01417,  0.01202}, 

far  c22[23]  =  {0.00448,  0.00094,0.00147,0.00149,0.00543,  0.0, 

0.0,  0.0,  0.0,  0.00507,0.00216,0.00501, 

0.01577,0.03006,  0.00954,  0.02425,0.00372,0.00225, 
0.01045,0.01636}, 

hr  c23[24]  =  {0.01837,  0.00248,  0.0,  0.0,  0.0,  0.0, 

0.0,  0.0,  0.0,  0.0,  0.0,  0.0, 

0.02040,0.00217,  0.00881,  0.01267}, 

far  c24[25]  =  {0.00190,0.00567,  0.0,  0.0,  0.0,  0.0, 

0.0,  0.0,  0.0,  0.0,  0.0,  0.0, 

0.00257,  0.00610,0.0165,  0.00487}, 

far  c25[26]  =  {0.00016,  0.01175,  0.0,  0.0,  0.0,  0.0, 

0.0,  0.0,  0.0,  0.0,  0.0,  0.0, 

0.00189,  0.01522,0.02361,0.00289}, 

far  c26[27]  =  { 0.00404, 0.0,  0.0,  0.0,  0.0,  0.0, 

0.0,  0.0,  0.0,  0.0,  0.0,  0.0, 

0.0,  -0.00323, 0.00688}, 

c27[28]  =  { 0.01022, 0.0,  0.0,  0.0,  0.0,  0.0, 

0.0,  0.0,  0.0,  0.0,  0.0,  0.0, 

0.0,  -0.00770, 0.02350, 0.0,  0.0,  0.0, 

0.0,  0.0,  0.0,  0.0,  0.0,  0.0, 

0.0,  0.0,  -0.01133,-0.00100}, 

far  c28[29]  =  {-0.02063, 0.0,  0.0,  0.0,  0.0,  0.0, 
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0.0, 

0.0, 

o 

6 

b 

b 

0.0,  0.0, 

0.0, 

0.0^)64,-0.00531.  0.0, 

,  0.0,  0.0, 

0.0, 

0.0, 

0.0. 

b 

b 

0.0,  0.0, 

0.0, 

0.0, 

0.00754,-0.00861,  0.00487}. 

fiur  c29(30]  =  {-0.00915,  0.0, 

o 

b 

0.0, 

o* 

b 

b 

b 

0.0. 

0.0, 

o 

b 

o 

b 

0.0.  0.0, 

0.0, 

-0.01083,-0.00974,  0.0, 

o 

b 

o 

b 

0.0, 

0.0, 

0.0, 

b 

b 

b 

b 

b 

b 

0.0, 

0.0, 

-0.01043}, 

far  c30[31]  =  {  0.0, 

0.0, 

b 

b 

b 

b 

0.0,  0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0,  0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0,  0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0,  0.0, 

0.0, 

*cc[31]  = 

{ 

cl,  cl,  c2,  c3. 

0.0, 

0.0, 

0.0, 

-0.01820}, 

c4,  c5,  c6. 

c7,  c8. 

c9,  clO,  cll,  cl2,  cl3 

cl4,  cl5.  cl6,  cl7 

,  cl8. 

cl 9.  c20.  c21.  c22.  c23,  c24,  c25,  c26. 

c28,  c29,  c30 

— 

static  double 
far  sl[l] 

=  {  0.0  }, 

far  s2[3] 

=  { 0.0, 

-0.00406,-1.39786  }, 

far  s3[4] 

=  { 0.0. 

0.25244,-0.62241,  1.41140}, 

far  s4[5] 

=  { 0.0, 

-0.46512,  0.66272,-0.20316,  0.29894}, 

far  s5[6] 

=  { 0.0, 

-0.09225,-0.32488,-0.20788,  0.05037,-0.66 18 1 } , 

fax  s6[7] 

=  {0.0,  0.01587,-0.34854,0.00138,-0.46086,-0.53881, 

-0.24196}, 

far  s7[8] 

=  {  0.0,  0.09607,  0.10505,-0.21778,-0.12689,  0.04367, 

0.13170,  0.02663}, 

far  s8[9] 

=  {  0.0. 

0.06327,  0.05121,-0.08830,  0.07539,  0.08245, 

0.32546,  0.07712,  0.12712}, 


far  s9[10]  =  {  0.0,  0.01676,-0.02467,-0.09715.  0.01072,-0.06410, 

0.21837,-0.07411,-0.01555,  0.09172}, 
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&r  sKHll]  s  {  0.0,  -O.I3SS3.-0.0037S,-0.16867.-0.06890.-0.03S50. 

-0.08597,  0.01616,-0.07159.-0.05053.-0.01962}. 

far  si  1[12]  =  {  0.0,  -0.01356,-0.09952.-0. 13577,-0.06082,  0.07889, 

0.03820,-0.08216,  0.02269.  0.03349,-0.00324,-0.07862}, 

far  sl2[13]  =  {  0.0,  -0.05415,-0.00931,  0.03136.-0.01663,  0.01287, 

0.03705.  0.04908,  0.02380,  0.01083,  0.05133,-0.00483, 
-0.01178}. 

far  sl3[14]  =  {  0.0,  0.03644,-0.03804,  0.0761 1.  0.00559,  0.04607, 

0.00278,-0.00121  ,-0.00321 ,  0.04194.-0.03227,-0.01686, 
0.09061,  0.06977}, 

far  sl4[15]  =  {  0.0,  0.04976,  0.04590,-0.01504,  0.00804,-0.02184, 

-0.00702,-0.03207,-0.00017.  0.01116.  0.01384,-0.03660, 
-0.03024,  0.04223,-0.00591}, 

far  sl5[16]  =  {  0.0,  -0.00236,  0.02976,  0.00562.-0.00720,-0.00533, 

-0.04249,  0.01133,  0.02563,  0.04074,  0.01124,-0.00421, 
0.01659,-0.00224,-0.02460,-0.00640}, 

far  sl6[17]  =  {  0.0,  -0.01232,  0.01566,-0.02645,  0.01158,-0.00269, 

-0.02266,-0.00553,  0.00567,-0.03781,  0.00788,  0.00936, 
0.00977,-0.00750,-0.03787,-0.02607,  0.01402}, 

far  sl7tl8]  =  (  0.0,  -0.02223,  0.01244,  0.00715,-0.00601,  0.00761, 

-0.00974,  0.01255,  0.00300,-0.01928,  0.01173,-0.00404, 
0.02126,  0.01921,  0.01083,  0.00393,  0.01308,-0.00090}, 

far  sl8[19]  =  {  0.0,  -0.00242,  0.02368,-0.00023,  0.01095,  0.01262, 

-0.00964,-0.00071,-0.01226,  0.02529,-0.01030,  0.01734, 
-0.02305,-0.03737,-0.00934,-0.01615,  0.01840,  0.00931, 
-0.01267}, 

far  8l9[203  =  {  0.0,  -0.00698,-0.00714,  0.00094,-0.00992,-0.00110, 

0.00323,  0.00852,-0.01796,  0.01924,-0.00637,  0.02493, 
0.00613,-0.03066,-0.01273,-0.01616,-0.01328,-0.00531, 
-0.02120,-0.00143}, 

far  s20[21]  =  {  0.0,  -0.02215,  0.00673,  0.01 130,-0.00797,  0.00204, 

-0.00024,-0.00353,-0.00465,  0.02218,-0.00746,-0.00997, 
0.02576,  0.00394,-0.01019,  0.00947,-0.00130,-0.00674, 
0.02895,  0.00864,-0.00508}, 

far  s21[22]  =  {  0.0,  0.00749,  0.00653,  0.00381,-0.00155,  0.0, 

0.0,  0.0,  0.0,  -0.00175, 0.00268,-0.01019, 

0.02249,  0.01387,  0.01031,  0.01209,-0.00542,-0.00243, 
-0.01220,-0.00849}, 
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i»f  s22[231  »  {  0.0,  0.00554,-0.00964.  0.01117,  0.00422.  0.0, 

0.0,  0.0.  0.0.  -0.00136, 0.00094.-0.02392, 

-0.01916,  0.00774,  0.00665,  0.00033,-0.00436,-0.00325. 
-0.01016.-0.02256}. 

far  s23[24]  «  {  0  0,  0.00907, 0.0,  0.0,  0.0,  0.0, 

0.0,  0.0,  0.0,  0.0.  0.0.  0.0, 

0.01049,-0.00165,-0.00568.  0.00258}, 

fitf  s24[25]  *  { 0.0,  -0.00119.0.0.  0.0,  0.0,  0.0, 

0.0,  0.0,  0.0.  0.0.  0.0,  0.0, 

-0.01462,-0.00728.  0.00317.-0.00157}, 

far  s25t26]  =  {  0.0,  -0.00442,  0.0,  0.0,  0.0,  0.0, 

0.0,  0.0.  0.0,  0.0,  0.0,  0.0, 

0.00732.-0.00880,  0.01669.-0.00148}, 


far  s26[271  =  {  0.0, 

0.0, 

0.0.  0.0,  0.0, 

0.0. 

0.0, 

0.0, 

0.0.  0.0,  0.0. 

0.0, 

0.0.-0.0082G,  0.00148}, 

far  s27[28]  =  {  0.0. 

0.0, 

0.0.  0.0,  0.0, 

0.0, 

0.0, 

0.0, 

o 

b 

o 

b 

o 

b 

0.0, 

0.0. 

-0.01073,  0.00612,  0.0,  0.0, 

.  0.0, 

0.0, 

0.0, 

o' 

6 

b 

6 

b 

b 

0.0, 

0.0, 

0.0, 

-0.00526,-0.00332}, 

far  S28I29]  =  {  0.0, 

0.0, 

0.0,  0.0,  0.0, 

0.0, 

0.0, 

0.0, 

0.0,  0.0.  0.0, 

0.0, 

0.0, 

0.00875,-0.01 147,  0.0,  0.0 

,  0.0, 

0.0, 

0.0, 

o' 

b 

b 

b 

b 

b 

0.0, 

0.0, 

0.0, 

-0.00232,  0.00306,  0.00612}, 

far  s29(30]  =  {  0.0, 

0.0, 

b 

b 

b 

b 

b 

b 

0.0, 

0.0, 

0.0, 

0.0,  0.0,  0.0, 

0.0, 

0.0,  -0.008%,  0.00956, 0.0,  0.0,  0.0, 


e  o 
b  b 

0.0, 

0.0, 

0.0,  0.0, 
-0.01602}, 

0.0, 

0.0, 

far  s30[31]  =  {  0.0, 

0.0, 

0.0, 

b 

b 

o' 

b 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

0.0, 

-0.03494}, 

*ss[311  * 

i 

si,  si,  s2.  83, 

84,  I 

5.  s6,  s7,  s8. 

s9,  810, 

sll,  sl2. 

sl3,  sl4.  sl5.  sl6,  sl7. 

sl8,  sl9. 

s20,  821,  s22,  s23,  s24.  s25. 

s26,  827,  s28.  s29.  f30 
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}; 


* - */ 

void  geiii_9_iiiodel_dabi(double  *plaiiet_inu,  double  '*pUoet_radius, 

double  ^lanet_oiiiega,  double  ''^lanet_fUtteiung, 
double  '*planet_J2,  double  *c,  double  *s) 

{ 

/* - 

*/ 

int  n,mJ_coef; 
double  coef.facr; 

/♦ - 

*1 

for(ii  =  2;n  <  31;  n++) 

{ 

for(ni  =  0;  m  <  =  n;  m++) 

{ 

j_coef  =  (n*n  +  n  -4)/2  +  m; 
if(m  =  =  0) 

{ 

c(J  coef]  =  sqrt(  (double)(2*n  +  1)  )*  cc[n][0]*1.0e-6; 

} 

else 

{ 

fiwr  =  factorial_ratio((n-ni),(n+in)); 

coef  =  sqrt(  (doubleKd**^  +  2)  *facr)*I  .Oe-6; 

ctj_coef]  =  coef  "■  cc[n][in]; 

8[j_coef|  =  coef  *  ss[n][m]; 

} 

} 


'*^laiiet_niu  =  398600.64;  /*  kiloiiieters**3/sec**2  */ 

*pluiet_ndiu8  =  637L.139;  /**  kilometers  "'/ 

*planet_omega  =  7.2921 1514646e-5;  /*  radians/second  */ 
‘')>laaet_fIatteoing  —  1 .0/298.257;  /*  no  units  */ 

^lanetJ2  =  -cIl];  /*  no  units  */ 


) 
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This  is  ’get_roUUioa_aDgle8’ 

Input  arguments  are  - 

jd  s  Julian  date 
Return  arguments  are  - 

X 

y 

utl_minus_utc 

'get_rotation_angles*  is  called  by  ’compute_a_matrix* 

Requires  the  IERS.dat  file  containing  US  Naval  Observatory  predictions 

jNnclude  <const.h> 

#include  'iers.h'' 

void  get_rotation_angles(double  jd,  struct  1ERS_DATA  *IERS, 

double  "'x,  double  *y,  double  'Nitl_minus_utc) 

{ 

int  i,  iml; 

double  modifiedJulian_date,  factor; 

modifiedJulian_date  «  jd  •  2400000.3; 

if  ((modified  Julian_date  <  lERS-  >  mjd[0])  1 1 
(modified Julian  date  >  lERS- >  mjd[89])) 

{ 

*x  =  0.0; 

*y  =  0.0; 

*utl_minus_utc  =  0.0; 

printfCIERS  error:  I  need  %6.0f,  file  has  %6.0f  to  %6.0f\n', 
modified JuUan_date,  lERS- >  mjd[0],  IERS->mjd[89]); 

} 

else 

{ 

for(i=0;  i<s89;  i+-f)  {  if  (IERS->mjd[i]  >  modiiiedJulian_date)  break;} 
iml  B  i-1; 

Ourtor  s  (nx>difiedjulian_date  -  IERS->mjd[iml])  /  (IERS->mjd[i]  -  IERS->mjd[iml]); 

*x  =  IERS->x[iml]  +  (IERS->x[i]  -  IERS*>x[iml])  '*  factor; 

*y  a*  IERS->y[iml]  +  (IERS->y[i]  -  IERS->y[iml])  *  fmtor; 

♦utJ_minus_ulc  =  I£RS->tfim]]  +  (IERS->t(iJ  -  IERS*>t[im]])  *  fiKtor; 

♦x  ■*=  DEGREES  /  3600.0; 

*y  *=  DEGREES  /  3600.0; 

} 

} 
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/*« 


* - *! 

#include  <orbiiiechl.b> 

void  gotpot(Perturb«tions  '"P,  int  toUl^^gnvity,  double  posiUoD[4], 
double  position  mag,  double  g[4],  double  *pot) 

{ 

double  ri,  xovr,  yovr,  zovr,  ep; 

double  muor,  muor2,  reor,  leora,  sumv; 

double  pa[38],  pnml[38],  pnm2[38],  ctil[38],  8til[38]; 

double  sumh,  sumgam,  sumj,  sumk,  sumh_n,  npl,  lambda; 

double  sumgam_n,  sumj_n,  sumk_n,  mxpnm,  twonml,  npmpl; 

double  sumv  n,  bnmtil,  pnmbnm,  anmtml,  bnmtml; 

int  mml,  mpl,  nml,  nm; 
int  j,  k,  L,  lim,  m,  n; 

/♦ - 

*1 

ri  —  1 .0/position_mag; 
xovr  =  position[t]'^; 
yovr  =  position[2]'*ri; 
zovr  =  position[3]''ri; 
ep  =  zovr; 

reor  =  P-> Gravity. GMD.pianet_radius  *  ri; 
reom  =  reor; 

muor  =  P->  Gravity. GMD.planet_mu*ri; 
muor2  =  muor*ri; 

k  =  0; 

L  =  P->  Gravity. number_tesserai  +  2; 

for  (m  s=  1;  m  <  =  L;  m++) 

{ 

pnm2[m]  =  0.0; 
pnmt[m]  =  0.0; 

} 

pnm2[0]  =  1 .0; 
pnml[0]  s  ep; 
pnml[l]  »  1.0; 
ctil[0]  s  1 .0; 
stil[0]  a  0.0; 
ctU[l]  s  xovr; 
stil[l]  s  yovr; 

sumv  s  (double)totai _gravity; 
sumh =0.0; 
sumj =0.0; 
sumk =0.0; 


gotpot.c 
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sumgun  s  (double)toUl jgnivity; 

/* - 

*1 

for  (n  ■*2;  n  <»  P-> Gravity. Duiiiber_zoiul;  n++) 

{  /*Siun  over  zonals  */ 

nom  =  reom*reor; 
twonml  =  (double)(2'*o*l); 

ninl  —  n-I; 

npl  s  (double)(n  +  1); 

L  =  1; 

//  RECURSIVE  COMPUTATION  OF  LEGENDRE  POLYNOMIAL  -  pn[0]  // 
//  and  first  associated  legendre  function  pn[l]  // 

pn[0]  =  (twoninl'*ep'*^ninl[0]  -  (double)(nml)''^nin2[0])/(double)(n); 
pn[l]  =  pnin2[l]  +  twonml ‘'^ninl[0]; 
pn[2]  =  pnm2[2]  +  twonml ''pnml[l]; 

k  =  k  +  1; 

sumv_n  =  pn[0]*P->  Gravity. GMD.cc[k]; 
sumh_n  =  pn[l]*P->  Gravity. GMD.cc[k]; 
sumgam_n  *  pn[0]*P->  Gravity. GMD.cc[k]*npl; 

if(P->  Gravity.  number_tcsscral  >  0) 

{  /*  ignore  tesserals  if  number_tesseral  =  0  *1 

sumj_n  =  0.0; 
sumk_n  =  0.0; 

ctil[nl  =  ctil[l]'*‘ctil[nml]  -  stil[ll'*'stil[nml]; 
stil[n]  =  stil[l]'''ctil[nml]  +  ctil[l]'*'stil[nml]; 

if  (n  <  P->  Gravity. number_tesseral) 
lim  =  n; 

else 

lim  =  P->  Gravity. number_tesseral; 
for(m  =1;  m  <=  lim;  m++) 

{  /"'Sum  over  tesserals  "■/ 

mml  =  m-1; 
mpl  =  m  +  1; 
npnq>l  =  (double)(n  +  n^tl); 

/* - // 

//  RECURSIVE  COMPUTATION  OF  ASSOQATED  LEGENDRE  // 
//  FUNCTIONS  -  pntm  +  1]  // 

// - */ 
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pn[ovl]  =  piiii]2[mpl]  -t-  twoiunl*t”iml[iD]; 
mxpnm  =(doubleXin)*pn[in]; 
am  =  k  -f  m; 

bnmtil  -  P->Gimvily.GMD.cc[nin]'*ctU(ni  ]  +  P-> Gravity .GMD.ssliun]*stil[m  ]; 
pnmhnm  s  pD[in]*blUIltil; 
sumv  n  =  sumv  n  +  ptunbnin; 

bDmtml  =  P->  Gravity, GMD.ccIiiin]*ctUtminl]  +  P->Gravity.GMD.ss[iini]'»stil[mmll; 

anmtml  =  P->Gravity.GMD.ccIiim]*stil(mml]  -  P-> Gravity. GMD.ss[iun]*ctil[mnil]; 

8uinb_n  s  suiiih_D  4-  pn[iiipl]*biuntil; 

sumgain_n  —  sumgain_ii  +  npn^l'^pnmbam; 

suiiij_n  =  suinj_n  +  mxpnm'^biiintml; 

suiiik_n  =  $uink_o-mxpain'*^uinitinl; 

)  /*  end  of  sum  over  tesserals  */ 

sumj  =  sumj  +  reom*sumj_n; 
sumk  s  sumk  +  reom'''suink_n: 


} 

/* - // 

//  SUMS  BELOW  HERE  HAVE  VALUES  WHEN  M  =  0  // 

// - */ 

sumv  =  sumv  +  reofii*sumv_n; 
suinfa  =  sumfa  +  reorn*suinb_a; 
sumgam  a:  sumgam  +  reom*sumgam_a; 

k  =  k  +  n; 

/* - // 

//  SHIFT  LEGENDRE  POLYNOMIALS  DOWN  // 

// - <*>/ 

if  (n  <  P->  Gravity. number  zonal) 

{ 

L  =  n; 

for  (j  =  0;  j  <  =  L;  j++) 

{ 

pnm2[j]  =  pnml[j]: 
pnml[j]  =  pn[jl; 

} 

} 

}  /^end  of  sum  over  zonals  */ 

*pot  =  muor*sumv; 
lambda  —  sumgam  +  ep'''sumh; 
g[l]  =  -muor2''^ambda'''xovr  -  sumj); 
g[2]  =  -muor2*(l*mM»''Yovr  -  sumk); 
g[3]  =  -muor2'''0>m>bda*zovr  -  sumh); 
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} 


void  get _gravity_dabi(Perturt>atioiis  ♦P,  double  *inu,  double  *^2, 
double  *plenet_ndius,  double  '*pUnet_nte, 
double  "ilatteiiing) 

{ 

*inu  =  P->  Gravity. GMD.plaiiet_mu; 

^2  =  P->Gravity.GMD.plaiietJ2; 

''^ianet_radius  =  P->  Gravity  .GMD.planet_radius; 

''^luiet_rate  »  P->  Gravity. GMD.planet_oniega; 

"‘flattening  =  P->  Gravity. GMD.planetJfUttening; 

} 

* - 

void  instantiate_gotpot(int  niodel_naine,  Perturbations  "'P) 

{ 

switch  (model  niune) 

{ 

case  1; 

gem_9_nK)del_data(&P-  >  Gravity  .GMD.planet_mu, 

&P-  >  Gravity  .GMD.pianet_radius, 
&P-  >  Gravity  .GMD.planet_omeg8, 
&P-  >  Gravity  .GMD.pianet_flattening, 
&P- >  Gravity  .GMD.planetJ2, 

&P-  >  Gravity.GMD.ee, 

&P- >  Gravity. GMD.ss); 

break; 
case  2: 
break; 

} 

} 
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fifadcf  lERSJNCLUDED 
#define  lERSJNCLUDED 

struct  lERS  DATA  { 
double  mjd(90],  x[90],  y[90].  t[90]  ; 
}: 

#endif 
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f^^atn^ilf^,^^alf*iti^m**tML**4‘************************************>lf*****‘*********** 

This  is  the  'get_inMtia]_to_wgs84_tiutrix' 

Input  arguments  are  - 

time  *  time  of  day  in  seconds  past  midnight 
Return  arguments  are  - 

MS0_to_WGS84  =  4x4  matrix  with  the  zero  elements  unused; 

the  1,2,&3  row/column  elements  are  the  MS0_to_WGS84 
transformation  matrix  elements. 

’get_inertiaJ_to_wgs84_matrix’  is  called  'Derivatives’ 

’get_inertial_to_wgs84_matrix’  calls  - 

’compute_a_matrix’ 

'rotation_generator’ 

’matrix_x_matrix’ 

^include  <orbmechl.h> 

#include  "mpmSO.h* 
ll^clude  "iers.h” 

void  get_inertia]_to_wgs84_matrix(double  time,  double  jd_midnight,  RNP  '*'mSO, 

double  planet_omega, 
struct  lERS  DATA  *1£RS, 
double  MSO  to  WGS84{4][4]) 

{ 

double  time_since_qpoch,  G[4][4],  M50_to_EF[41[4],  A[4][4]; 

time_since_epoch  «  time;  /*  time  in  seconds  since  midnight  UTC  */ 
compute_a_matrix(timeJd_nudnight,IERS,A); 
rotation_generator(time_since_qx)ch  *  planet_omega,  G); 

mBtrix_x_niatrix(G,m50-  >  nip,M50_to_EF); 
matrix_x_matrix(A,M50_to_^,M50_to_WGS84); 


itowga84.c 


jacatm.c 

#include  <owth.h> 
finciude  <const.h> 
iHnclude  "util.h'' 

#defme  euth_fIattening_fKtor  (1.0  /  298.257) 

^define  polar_eqiiatoria]_ntio_&quaKd  pow(1.0  •  eai1h_flatteiung_0ictor,2.0) 

#defuie  days_in_tropicaI_year  365.2422 

#define  pliuiet_oblate_coefficient  ((earth_flatteaiiig_factor  (2.0  -  earth_flattenmg_factor))  /  pow(1.0 

-  earth_flattening_factor,2.0)) 

#deflne  beta  (-37.0  *  DEGREES)  /*  detennines  lag  of  the  maximum  exospheric  temperature  */ 

#deftne  p  (  6.0  *  DEGREES)  /*  introduces  in  the  temperature  curve  an  asynunetry  */ 

#define  gamma  (  43.0  DEGREES)  /*  detennines  the  location  of  the  of  the  a^mmetry  */ 

#deftne  r  0.31  I*  fixes  the  relative  amplitude  of  the  temperature  variation  *! 

void  equatorial_solar_ephemeris  0: 

This  is  the  call  to  ’set_data’.  It  creates  ’density_table’. 

Input  arguments  are  - 
void 

Return  arguments  are  - 

density_table  matrix  defined  in  *jacchia_data 

This  segment  calls  'jacchia_data’  in  jacdat.c 

static  double  density_table(68][31]; 

void  setjacchia  data  0 

{ 

jacchia_data(density  table); 

} 

This  is  the  fiinction  ’jacchia_densily’ 

Input  arguments  are  - 

inertial_position  =  a  vector 

earth_fixed_position  s  a  vector 

radius  =  magnitude  of  position  vector 

at_time  =  Julian  date 

8olar_flux  =  F10.7  observed  at  time  of  nseasurement 

mean_solar_flux  »  mean  F10.7  for  previous  162  day  period 

geomagnetic_index_q>  =  geomagnetic  activity  mdex  6.7  hours  prior 

to  measurement 

Return  arguments  are  - 

(double)  value  of  atmospheric  density  in  grams  per  cm‘'3 

'jacchia_density’  is  called  by  ’Derivatives’ 

'jacchia_da)sity'  calls  •  ’equiloriaI_solar_q)hemeris 

’Jdtocd’  in  util.c 
’julian_date’  in  util.c 


jacatB.c 


jacata.c 


double  j«cchia_deiisity(iiteftUljxMitioo,eutfa_fixed_position, 
radius,  at_tiiiie,  8o]ar_flux,me«n_solsr_flux, 
geomignetic_iiKiex_^>) 

double  inertialjxisitioiiQ,  eaith_fixedj)08itiooQ.  radius,  st_time  ; 
double  solar_flux,ineai)_solsr_flux,geoiiiagDedc_index_ap; 


int  year,  mooth,  day,  hour,  minute  ; 
int  table_index_l  ;  I*  for  density_table  *! 

int  table_index_2  s  2;  /*  for  density_tabie  */ 

int  pievious_table_index_l  ;  /*  for  dea8ity_table  */ 
int  previous_table_index_2  ;  /*  for  density_table  ♦/ 

double  altitude_niodelO,  altitude,  log_density,  dht ; 
double  sin_theta,  day_ratio,  seconds,  tau,  last_day  ; 

/*  double  niean_8olar_fIux  ;  /*  10**-22  watts/m**2/h2  */ 
/*  double  solar_flux  ;  /*  l0**-22  watts/m*'''2/h2  ♦/ 


double  exospheric_niinimuffi_tei^)erature  ; 
double  geomagnetic_adjustment  ; 
double  semi  annual  variation  ; 


/*  kelvin  */ 
I*  kelvin  */ 
/*  kelvin  */ 


double  suo_vector[4]  ; 

double  sun_declination  ;  /*  radians  */ 

double  sun_right_ascension  ;  /*  radians  */ 

double  sin_sun_right_ascension,  cos_sun_rigbt_ascension  : 


double  suo_bour_angle  ; 


I*  radians  •/ 


double  geodetic_latitude  ; 

double  eta  ; 
double  sin_m_theta  ; 


I*  of  inertial  jx>sition  (precession  &  nutation  assumed  *! 
!*  to  be  neglible)  */ 

/*  radians  */ 

/*  sin  ""*■  m  (theta),  where  m  =  2.5  "•/ 


double  diurnal_variation  ; 
double  exospberic_temperature  ; 


/*  kelvin  */ 
/*  kelvin  *! 


double  delta_exoq)heric_temperature  ; 
double  delta_altitude  ; 
double  delta_log_density  ; 


/*  kelvm  */ 

/•  km  */ 

/♦  accounts  for  *! 
/"•  seasonal-  */ 
I*  latitudinal  */ 
/*  variations  */ 


/* - // 

//  compute  altitude  index  // 

// - •/ 

sin_theta  earth_fixedjx>sitioo[3]/radius  ; 
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altitude  ss  nulius  -  6368.14  /  sqrt  (1.0  + 

planet_oblate_coefficieat  *  pow(sin_theta,2.0))  ; 

if(altitude  <  10.0) 

{ 

/* - // 

//  will  extrapolate  linearly  below  10  km  // 

// - */ 

dht  =  5.0; 

table  index  1  «  3  ; 

} 

else  iftaltitude  <  90.0) 

{ 

dht  =  5.0; 

table_index  1  =  (int)floor((altitude  -  10.0)/5.0)  +  3; 

} 

else  if(aititude  <  1 10.0) 

{ 

dht  =  2.0; 

table_index_I  =»  (int)floorC(altitude  •  90.0)/2.0)  +  19; 

} 

else  if(altitude  <  160.0) 
dht  =  5.0; 

table  index  1  =*  (int)floor((altitude  -  110.0)/5.0)  +  29; 

} 

else  if(altitude  <  400.0) 

{ 

dht  =  10.0; 

table  index  1  s  (int)floor((altitude  -  160.0)710.0)  +  39; 

} 

else  if  (altitude  <  1000.0) 

{ 

dht  =  20.0; 

table  index  1  =  (int)floor((altitude  -  400.0)720.0)  +  63; 

} 

else  if(altitude  <  1500.0) 

{ 

dht  s  50.0; 

table_index  1  =  (int)floor((altitude  -  1000.0)750.0)  +  93; 

} 

else 

{ 

dht  «  100.0; 

Uble_index_l  s  (int)floor((altitude  -  1500.0)7100.0)  +  103; 
if(table  index  1  >  112) 

{ 

/* - // 

77  will  extrapolate  linearly  above  2500  km  77 

// - */ 


jacatm.c 


jaeatm.c 


table  index  1  «  112; 

> 

} 

previous_tible_iBdex_l  =  table_bdex_l  -  1; 

if(altitude  >  90.0) 

{ 

/* - n 

//  calculate  diurnal  variation,  equation  17,  (jacchia,  1970)  // 

// - 1 - */ 

equatorial_solar_q>heineris  (at_time,  sun_vector); 

sun_declination  »  asin  (sun_vector  [3]); 

sun_ri^t_ascension  »  atan2  (sun_vector  [2],  sim^vector  [1]); 
sin_sun_right_ascension  —  sin  (sun_right_ascension); 
cos_sun_right_ascension  —  cos  (sun_right_ascaision); 

sun_hour_angle  ^  atan2 

((inertia]_position  [2]  *  cos_sun_right_ascension  • 
inertial_position  [1]  *  sin_sun_ri^t_a8cension), 
(inertial_position  [1]  *  cos_sun_right_ascension  -f 
inertialjMsition  [2]  *  sio_sun_ri^t_asceosion))  ; 

tau  «  sun_hour_angIe  +  beta  +  p  *  sm  (8un_liour_angle  +  gamma); 

if(Uu  <  -PI) 

{ 

tau  s  tau  +  TWO  PI; 

} 

else  if(tau  >  H) 

{ 

uu  s  tau  -  TWO_PI; 

} 

geodeticjatitude  atan  ((ineitialjxnition  [3]  / 

aqit  (pow(ineitialj>osition  [1],2.0)  -l- 
pow(ineitiaI  jxwition  [2],2.0)))  / 
poIar_equatoriaI_fatio_squared); 

eta  «  0.5  *  (geodetic_latitude  -  suo_decliBation); 

8in_m_d)eta  >■  pow((sin  (O.S  "fibs  (geodetic_latitude  + 
sun_dMlination))),  2.S); 


/*  equation  14,  (jacchia,  1970)  */ 
exospheric_miniinum_teniperature  « 

383.0  +  1.52  •  meHi_aolar_flux  +  1.8  ♦  solar^flux; 
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diunul_vari«tion  «  exo8|riieric_iiiuiimuin_tetnpermtui«  * 

(1.0  +  r  *  sui_m_diete  + 
r  "•  (  pow(cos  (eU),2.S)  -  sin_m_^tbeu)  * 
pow(cos  (tni  /  2.0),3.0)); 

/* - // 

//  calculate  geomagnetic  adjustment,  equation  22,  0*cclua>  1970)  // 

// - 1 - */ 

geomagnetic_adjustnieat  « 

geomagDetic_index_iq>  +  100.0 

(1.0  -  exp  (-0.08  *  geoniagnetic_index_ap)); 

I*  calculate  senu_annual_variation,  equation  23,  (jacchia,  1970) 

jdtocd  (at_time,  Amontb,  &day,  &year,  &tiour,  &minute,  dueconds); 
last_day  =  Julian_date(year-1,  12,  31,  0,  0,  0.0)  ; 
day_rBtio  *  (at_tinic  -  last_day)  /  days_in_tropical_year; 

tau  *  day_ratio  0.1145 

(pow(((1.0  +  sin  (TWO_PI  *  day_iatio  +  342.3  *  DEGREES)) 
/  2.0),2.16)  -  0.5); 


semi  annual  variation  =  2.41  -f  mean  solar_flux 

(0.349  +  0.206  *  sin  (TWO  Pl  *  tau  +  226.5  *  DEGREES))  ♦ 
sin  (2.0  *  TWO_PI  *  Uu  +  247.6  *  DEGREES); 

exospheric_temperature  »  diumal_variation  + 

geomagnetic_adjustment  -I-  senu_annuaI_variation; 

if(exospheric  temperature  >  600.0) 

{ 

ifCexospheric  temperature  <  2000.0) 

{ 

previous_table_index_2  =  (int)floor(0.02  ♦ 

(exospheric_temperature  •  6(X).0))  +  2; 
delta_exospheric_temperature  s  0.02 
(exo8(dieric_temperature  - 
density  table(l][previous_table  index  2]); 

}  ■ 

else 

{  /'hise  as  2000  (table_index_2  will  be  30th  point  m  table)  *f 
previous_table_index_2  =  29; 
delta  exospheric  temperature  s  i.O; 

} 

table_index_2  *=  previous_table_index_2  -I-  1; 

log_density  =  density_table  [previous_table_index_l][previous_table_index_2]  -f 
delta_exospheric_teniperature 

(density_ti^le  [previous_table_inde^_l][table_index_2]  - 
deosity_table  [previous_table_index_l][previous_table_index_2]); 
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deltaJog_density  *  deiisity_Uble  [Uble_iiidex_lKprevioiu_uble_iiidex_21  + 
d6lU_exoq>heric_teo^)ef«ture'*' 

(density_table  [Uble_iiidex_l][table_iodex_2]  • 
density  table  {table  index  I  {[previous  table  index_2]); 

} 

else 

{ 

/* - // 

//  assume  exospheric_temperaturB  is  600,// 

//  interpolate  on  altitude  only  // 

log_density  =  density_table  [previous_table_index_I][2); 
deltaJog_density  «  density_table  (table_index_l][2]; 

} 

delta_altitude  =  (altitude  •  density_table  [previous_table_index_l][l])  /dht; 

log_density  »  log_den8ity  +  delta_altitude 

(deltajog^density  -  log_deasity); 


if(altitude  <  300.0) 

{  /♦  (  but  >  =  90  )  ■*/ 

/* - // 

//  equation  24,  (jacchia,  1970)  // 

// - *! 


deltaJog_density  =  0.02  *  (altitude  -  90.0)  • 

exp  (-0,045  *  (altitude  -  90.0))  * 
(pow(ineitial_position  [3],2.0)/ 

dot  (ineitialjK>sition,ioeiti8}_position)) 
sin  (TWO_H  *  (day  +  99.0)  / 
days  in  tiopical_year); 

} 

else 

{ 

deltajog  density  »  0.0; 

} 

} 

else 

{  I*  altitude  <  90  here,  and  there  is  no  temperature  effect  */ 

delta_altitude  »  (altitude  - 

density_table  [previous_^table_index_l][l])  /  dht; 

log_density  «  density_table  [previous_tabie_uidex_l][2]  - 
delta_altitude  *  (deosity_table  [table_bdex_l][2]  - 
density_tid>le  ^M«viou8_table_index_l][2]); 

de)tajog_deosity  «  o.O; 
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} 


/*  altitude  >  90.0  *! 


} 


return  pow(10.0,(Iog_density  +  delta_log_daisity)); 

/*  (graiiis/ciii'^3)  */ 


This  is  the  function  equatorial_soIar_ephemeris 
Input  arguments  are  • 

at_tiine  »  Julian  date 
Return  arguments  are  - 

sun_vector  =  normalized  sun  pointing  vector 

’equitorial_soiar_ephemeris*  is  called  by  ’jacchia_d«isity' 
'equitorial_solar_ephemeris’  calls  - 

'jdtocd*  in  util.c 
’julian_date'  in  util.c 

void  equatorial_solar_ephemeris  (at_time,sun_vector) 

double  at  time,  sun  vectorQ  ; 

{ 

double  celestialjongitude,  meanjulian_date  ; 
double  cos_declination,  cos_right_ascen8ion  ; 
double  sin_declioation,  sin_right_ascension  ; 

double  day_ratio,  year,  seconds  ; 

int  whole_year,  day,  month,  hour,  minute  ; 

jdtocd  (at_time,  &month,  &day,  &who]e_year,  &bour,  &minute,  &seconds); 
day  =  at_time  -  JuIian_date(wbole_year,  1,  1,  0,  0,  0.0) ; 

day_ratio  =  day  /  days_in_tropical_year; 
year  =  whole_^ear  +  day_ratio; 

meanjulian  date  =  24398S6.0  +  days_in_tFopical_year  * 

(year  -  1968.0)  -  2435839.0; 

celestialjongitude  s  0.017203  meanjulian_date  + 

0.0335  *  sin  (0.017203  meaDjuUan_date)  •  1.41; 
celestialjongitude  «  celestialjongitude  -  TWO_PI  '* 

(  (int)  (celestialjongitude  /  (TWO_H))); 

sin_declination  ^  sin  (celestialjongitude)  *  sin  (OBLIQUITY); 
cos_declination  =  sqrt  (1.0  -  pow(sin_declination,2.0)); 

stn_right_a8cension  «  sinjdeclination  / 

(cos_declination  *  tan  (OBUQUITY)); 
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cos_rig|it_MceasioD  »  cos  (celestisljoogitude)  /  cos_declinstion; 


sun_vector(l] 

suii_vector{2] 

suii_vector[3J 


cos_decliiistioo  *  co8_right_sscension  ; 
cos_decUiudon  '*  fiii_right_asceiisioo  ; 
sin  declination  ; 


} 
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*  built  by  Bob  Gottlieb  and  Mike  Fraietta 

*  Jan  1993 


static  double 
Aucl[31]  « 


farc2[31]  = 


farc3[31]  * 


farc4[311  = 


farc5[31]  * 


fiu-c6[31]  s 


•*/ 


{0.0. 

0.00, 

600.00, 

650.00, 

700.00, 

750.00, 

800.00, 

850.00, 

900.00, 

950.00, 

1000.00, 

1050.00, 

1100.00, 

1150.00, 

1200.00. 

1250.00, 

1300.00, 

1350.00, 

1400.00, 

1450.00, 

1500.00, 

1550.00, 

1600.00, 

1650.00, 

1700.00, 

1750.00, 

1800.00, 

1850.00, 

1900.00, 

1950.00, 

2000.00  } 

> 

{  0.0,  10.00000, 


-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437, 

-3.38437  } 

> 

0.0,  15.00000, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287, 

-3.71287  } 

0.0,  20.00000, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

^.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530, 

-4.05530  } 

* 

0.0,  25.00000, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370. 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370, 

-4.40370  } 

> 

0.0,  30.00000, 

-4.74450, 

-4.74450, 

-4.74450, 

-4.744», 

-4.74450, 
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-4.74450,  -4.74450,  -4.74450,  -4.74450,  -4.74450, 
-4.74450,  -4.74450,  -4.74450,  -4.74450,  -4.74450, 
-4.74450,  -4.74450,  -4.74450,  -4.74450,  -4.74450, 
-4.74450,  -4.74450,  -4.74450,  -4.74450.  -4.74450, 
-4.74450,  -4.74450,  -4.74450.  -4.74450}, 

ftr  c7[31]  =  {  0.0,  35.00000, 

-5.08540,  -5.08540,  -5.08540,  -5.08540,  -5.08540, 
-5.08540,  -5.08540,  -5.08540,  -5.08540,  -5.08540, 
-5.08540,  -5.(W540,  -5.08540,  -5.M540,  -5.08540, 
-5.08540,  -5.08540,  -5.08540,  -5.08540,  -5.08540, 
-5.(»540,  -5.08540,  -5.08540,  -5.08540,  -5.08540, 
-5.08540,  -5.08540,  -5.08540,  -5.08540}, 

fiv  c8[31]  {  0.0,  40.00000, 

-5.41440,  -5.41440,  -5.41440,  -5.41440,  -5.41440, 
-5.41440,  -5.41440,  -5.41440,  -5.41440,  -5.41440, 
-5.41440,  -5.41440,  -5.41440,  -5.41440,  -5.41440, 
-5.41440,  -5.41440,  -5.41440,  -5.41440,  -5.41440, 
-5.41440,  -5.41440,  -5.41440,  -5.41440,  -5.41440, 
-5.41440,  -5.41440,  -5.41440,  -5.41440}, 

fu  c9[31]  =  (  0.0,  45.00000, 

-5.72560,  -5.72560,  -5.72560,  -5.72560,  -5.72560, 
-5.72560,  -5.72560,  -5.72560,  -5.72560,  -5.72560, 
-5.72560,  -5.72560,  -5.72560,  -5.72560,  -5.72560, 
-5.72560,  -5.72560,  -5.72560,  -5.72560,  -5.72560, 
-5.72560,  -5.72560,  -5.72560,  -5.72560,  -5.72560, 
-5.72560,  -5.72560,  -5.72560,  -5.72560}, 

far  cl0(31]  =  {  0.0,  50.00000, 

-6.00990,  -6.00990,  -6.00990,  -6.00990,  -6.00990, 
-6.00990,  -6.00990,  -6.00990,  -6.00990,  -6.00990, 
-6.00990,  -6.00990,  -6.00990,  -6.00990,  -6.00990, 
-6.00990,  -6.00990,  -6.00990,  -6.00990,  -6.00990, 
-6.00990,  -6.00990,  -6.00990,  -6.00990,  -6.00990, 
-6.00990,  -6.00990,  -6.00990,  -6.00990}, 

ftr  cl  1[31]  *  {  0.0,  55.00000, 

-6.27610,  -6.27610,  -6.27610,  -6.27610,  -6.27610, 
-6.27610,  -6.27610,  -6.27610,  -6.27610,  -6.27610, 
-6.27610,  -6,27610,  -6.27610,  -6.27610,  -6.27610, 
-6.27610,  -6.27610,  -6.27610,  -6.27610,  -6.27610, 
-6.27610,  -6.27610,  -6.27610,  -6.27610,  -6.27610, 
-6.27610,  -6,27610,  -6,27610,  -6.27610}, 

fu  cl2[31]  »  {  0.0,  60.00000, 

-6.54520,  -6.54520,  -6.54520,  -6.54520,  -6.54520, 
-6.54520,  -6.54520,  -6.54520,  -6.5452),  -6.54520, 
-6.54520,  -6.54520,  -6.54520,  -6.54520,  -6.54520, 
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-6.54520, 

-6.54520, 

-6.54520, 

-6.54520, 

-6.54520, 

-6.54520, 

-6.54520, 

-6.54520, 

-6.54520, 

-6.54520, 

-6.54520. 

-6.54520}, 

fiu-  Cl3[31] 

{0.0,  65.00000, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

•6.81450, 

-6.81450, 

-6.81450, 

•6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

•6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450, 

-6.81450}, 

hr  cl4[31] 

SS 

{ 0.0,  70.00000, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550. 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550, 

-7.10550}, 

fvcl5[31] 

s 

{ 0.0,  75.00000, 

-7.42/60, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760, 

-7.42760}, 

hr  cl6(3!] 

« 

{  0.0,  80.00000, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070}, 

hrcl7t31] 

a 

{  0.0,  85.00000, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

•8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990}, 

far  cl8[31] 

a 

{0.0,  90.00000, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

•8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-8.46100, 

-6.54S20. 

-6.S4S20. 


-6.81450. 

-6.81450. 

-6.81450. 

-6.81450. 

-6.81450. 


-7.10550. 

-7.10550. 

-7.10550. 

-7.10550. 

-7.10550, 


-7.42760, 

-1.42160, 

-7.42760, 

-7.42760, 

-7.42760, 


-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 

-7.78070, 


-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 

-8.16990, 


-8.46100, 

-8.46100, 

•8.46100, 

-8.46100, 

-8.46100, 
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•8.46100, 

-8.46100, 

-8.46100, 

-8.46100}, 

(*rcl9[311  « 

{0.0,  92.00000, 

-8.62000, 

-8.62000, 

-8.62000, 

-8.62000, 

-8.62000. 

-8.62000, 

-8.62000. 

-8.62000, 

-8.62000, 

•8.62000, 

-8.62000, 

-8.62000, 

-8.62000, 

-8.62000, 

•8.62000. 

-8.62000, 

•8.62000. 

-8.62000, 

-8.62000, 

•8.62000, 

-8.62000, 

-8.62000, 

-8.62000, 

-S.67O0O, 

-8.62000, 

•8.62000, 

-8.62000, 

-8.62000, 

-8.62000}, 

&r  c20[31]  » 

{0.0,  94.00000, 

-8.77900, 

-8.77900, 

-8.78000, 

-8.78000, 

-8.78000, 

-8.78000, 

-8.78000, 

-8.78000, 

-8.78000, 

-8.78000, 

-8.78000, 

•8.78000, 

-8.78000, 

-8.78000, 

-8.78000, 

-8.78000, 

-8.78000, 

-8.78100, 

-8.78100, 

-8.78100, 

-8.78100, 

•8.78100, 

-8.78100. 

-8.78100, 

•8.78100, 

-8.78100, 

-8.78100, 

-8.78100, 

-8.78100}, 

fi»r  c21t311  * 

{0.0,  96.00000, 

-8.93900, 

-8.94000, 

•8.94000, 

-8.94000, 

-8.94000, 

-8.94100, 

-8.94100, 

-8.94100, 

-8.94100, 

-8.94100, 

•8.94100, 

-8.94200, 

-8.94200, 

-8.94200. 

-8.94200, 

-8.94200, 

-8.94200, 

-8.94200, 

-8.94200, 

-8.94200, 

-8.94200, 

-8.94200, 

-8.94200, 

-8.94200. 

-8.94300, 

•8.94300, 

-8.94300, 

-8.94300, 

-8.94300}, 

farc22[31]  » 

{0.0,  98.00000, 

•9.09900, 

•9.10000, 

-9.10000, 

-9.10100, 

•9.10100, 

-9.10100, 

•9.10200, 

-9.10200, 

-9.10200. 

-9.10200, 

-9.10300, 

-9.10300, 

-9.10300, 

-9.10300, 

-9.10300, 

-9.10400, 

-9.10400, 

-9.10400, 

-9.10400, 

•9.10400, 

-9.10400, 

-9.10400, 

-9.10400, 

-9.10400, 

-9.10500, 

-9.10500, 

-9.10500, 

-9.10500, 

-9.10500}, 

far  C23I31]  * 

{0.0,  100.00000, 

-9.25800, 

-9.25900. 

-9.25900, 

-9.26000, 

-9.26100, 

-9.26100, 

-9.26200, 

•9.26200, 

-9.26200, 

-9.26300, 

-9.26300, 

-9.26300, 

-9.26400. 

•9.26400, 

-9.26400, 

-9.26400, 

-9.26400, 

-9.26500, 

-9.26500, 

-9.26500, 

-9.26500, 

-9.26500, 

-9.26500, 

-9.26500, 

-9.26600, 

-9.26600. 

-9.26600, 

-9.26600, 

-9.26600}. 

farc24(31]  » 

{0.0,  102.00000, 

-9.41500, 

-9.41600, 

-9.41700, 

•9.41800, 

-9.41800, 

-9.41900, 

-9.42000, 

-9.42000. 

-9.42100, 

-9.42100, 

-9.42100. 

•9.42200, 

-9.42200, 

-9.42200, 

-9.42300, 

-9.42300. 

-9.42300, 

-9.42300, 

-9.42400, 

-9.42400, 

-9.42400. 

•9.42400, 

•9.42400, 

-9.42400, 

-9.42500, 

-9.42500, 

-9.42500, 

•9.42500, 

-9.42500}, 
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hr  c25[31]  »  {  0.0,  104.00000, 

-9.57000,  -9.57100,  -9.57200,  -9.57300,  -9.57400, 

-9.57400,  -9.57500,  -9.57500,  -9.57600,  -9.57600, 

-9.57700,  -9.57700,  -9.57700,  -9.57800,  -9.57800, 

-9.57800,  -9.57900,  -9.57900,  -9.57900,  -9.57900, 

-9.58000,  -9.58000,  -9.58000.  -9.58000,  -9.58000, 

-9.58000,  -9.58000,  -9.58100,  -9.58100}, 

far  c26[31}  -  {  0.0,  106.00000, 

-9.72200,  -9.72300,  -9.72400,  -9.72500,  -9.72500, 

-9.72600,  -9.72600,  -9.72700,  -9.72700,  -9.72800, 

-9.72800,  -9.72800,  -9.72900,  -9.72900,  -9.72900, 

-9.73000,  -9.73000,  -9.73000,  -9.73000,  -9.73000, 

-9.73100,  -9.73100,  -9.73100,  -9.73100,  -9.73100, 

-9.73100,  -9.73200,  -9.73200,  -9.73200}, 

far  c27[31]  =  {  0.0,  108.00000, 

-9.87000,  -9.87100,  -9.87100,  -9.87200,  -9.87200, 

-9.87300,  -9,87300,  -9.87300,  -9.87400,  -9.87400, 

-9.87400,  -9.87500,  -9.87500,  -9.87500,  -9.87500, 

-9.87600,  -9.87600,  -9.87600,  -9.87600,  -9.87600, 

-9.87600,  -9.87600,  -9.87700,  -9.87700,  -9.87700, 

-9,87700,  -9.87700,  -9.87700,  -9.87700}, 

far  c28[31]  =  {  0.0,  110.00000, 

-10.01400,  -10.01400,  -10.01400,  -10.01400,  -10.01400, 

-10.01500,  -10.01500,  -10.01500,  -10.01500,  -10.01500, 

•10.01500,  -10.01500,  -10.01500,  -10.01500,  -10.01500, 

•10.01600,  -10.01600,  -10.01600,  -10.01600,  -10.01600, 

•10.01600,  -10.01600,  -10.01600,  -10.01600,  -10.01600, 

-10.01600,  -10.01600,  -10.01600,  -10.01600}, 

far  c29[31]  =  {  0.0,  115.00000, 

-10.35000,  -10.34800,  -10.34600,  -10.34500,  -10.34400, 

-10.34300,  -10.34200,  -10.34100,  -10.34000,  -10.33900, 

-10.33900,  -10.33800,  -10.33800,  -10.33700,  -10.33700, 

-10.33600,  -10.33600,  -10.33600,  -10.33600,  -10.33500, 

-10.33500,  -10.33500,  -10.33500,  -10.33400,  -10.33400, 

-10.33400,  -10.33400,  -10.33400,  -10.33300}, 

far  c3q31]  s  {  0.0,  120.00000, 

•10.65000,  -10.64500,  -10.64100,  -10.63700,  -10.63400, 

-10.63100,  -10.62800,  -10.62600,  -10.62400,  -10.62200, 

-10.62100,  -10.61900,  -10.61800,  -10.61700,  -10.61500, 

-10.61400,  -10.61300,  -10.61300,  -10.61200,  -10.61100, 

-10.61000,  -10.61000,  -10.60900,  -10.60800,  -10.60800, 

-10.60700,  -10.60700,  -10.60600,  -10.60600}, 

far  C31I31]  =  {  0.0,  125.00000, 

-10.91400,  -10.90500,  -10.89700,  -10.89100,  -10.88500, 
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far  c32[31] 


far  c33{31] 


&rc34[31] 


farc35[31] 


fv  c36[31] 


far  c37[31] 


•10.88000,  -10.87600,  -10.87200, 
-10.86200,  -10.86000,  -10.85700, 
-10.85100,  -10.85000,  -10.84800, 
-10.84400,  -10.84300,  -10.84200, 
-10.83900,  -10.83800,  -10.83800. 

{0.0,  130.00000, 

-11.14300,  -11.13000,  -11.11900. 
-11.09400,  -11.08700,  -11.08100, 
-11.06800,  -11.06400,  -11.06100, 
-11.05200,  -11.05000,  -11.04800, 
-11.04200,  -11.04100,  -11.03900, 
-11.03500,  -11.03400,  -11.03300, 


-10.86800,  -10.86500, 
-10.85500,  -10.85300, 
•10.84700,  -10.84600, 
-10.84100,  -10.84000, 
-10.83700}, 


-11.10900,  -11.10100, 
-11.07600,  -11.07200, 
-11.05800,  -11.05500, 
-11.04600,  -11.04400, 
-11.03800,  -11.03600, 
-11.03200}, 


{0.0,  135.00000, 

-11.34000,  -11.32400,  -11.30900, 
-11.27700,  -11.26900,  -11.26100, 
-11.24400,  -11.23900,  -11.23500, 
-11.22500,  -11.22200,  -11.21900, 
-11.21200,  -11.21000,  -11.20800, 
-11.20300,  -11.20100,  -11.20000, 

{0.0,  140.00000, 

-11.51300,  -11.49200,  -11.47500, 
•11.43600,  -11.42600,  -11.41700, 
-11.39700,  -11.39100,  -11.38600, 
-11.37400,  -11.37100,  -11.36800, 
-11.35900,  -11.35700,  -11.35500, 
-11.34900,  -11.34700,  -11.34600, 


-11.29700,  -11.28600, 
-11.25500,  -11.24900, 
-11.23100,  -11.22800, 
-11.21600,  -11.21400, 
-11.20600,  -11.20500, 
-11.19900}, 


•11.46000,  -11.44700, 
-11.41000,  -11.40300, 
-11.38200,  -11.37800, 
•11.36500,  -11.36200, 
-11.35300,  -11.35100, 
-11.34400}, 


{0.0,  145.00000, 

-11.66700,  -11.64200,  -11.62200, 
-11.57600,  -11.56400,  -11.55400, 
-11.53100,  -11.52500,  -11.51900, 
-11.50600,  -11.50200,  -11.49900, 
-11.49000,  -11.48700,  -11.48500, 
-11.47800,  -11.47600,  -11.47400, 


-11.60400,  -11.58900, 
-11.54600,  -11.53800, 
-11.51500,  -11.51000, 
-11.49500,  -11.49200, 
-11.48200,  -11.48000, 
-11.47200}, 


{0.0,  150.00000, 

-11.80800,  -11.77900,  -11.75500, 
•11.70100,  -11.68900,  -11.67700, 
-11.65100,  -11.64400,  -11.63800, 
-11.62300,  -11.61900,  -11.61500, 
-11.60600,  -11.60300,  -11.60000, 
-11.59300,  -11.59100,  -11.58900, 


-11.73400,  -11.71700, 
-11.66700,  -11.65900, 
-11.63300,  -11.62800, 
-11.61200,  -11.60900, 
-11.59800,  -11.59600, 
-11.58700}, 


{0.0,  155.00000, 

-11.94000,  -11.90600,  -11.87800, 
-11.81700,  -11.80200,  -11.78900, 
-11.76000,  -11.75200,  -11.74600, 


-11.85400,  -11.83400, 
-11.77800,  -11.76800, 
-11.74000,  -11.73400, 


jacdat.c 


jacdat.c 


far  c38[31] 


far  c39[31] 


far  c40[31] 


far  c41[31] 


far  c42[31] 


far  c43[31] 


-11.72900,  -11.72500, 
-11.71100,  -11.70800, 
-11.69700,  -11.69500, 

{0.0,  160.00000, 
-12.06400,  -12.02500, 
-11.92300,  -11.90700, 
-11.86000,  -11.85100, 
-11.82600,  -11.82100, 
-11.80600,  -11.80300, 
-11.79200,  -11.79000, 

{0.0,  170.00000, 
-12.29600,  -12.24800, 
-12.11900,  -12.09800, 
-12.03900,  -12.02900, 
-11.99800,  -11.99300, 
-11.97500,  -11.97200, 
-11.96000,  -11.95700, 

{0.0,  180.00000, 
-12.51200,  -12.45300, 
-12.29700,  -12.27100, 
-12.19900,  -12.18600, 
-12.14900,  -12.14300, 
•12.12200,  -12.11800, 
-12.10500,  -12.10200, 


{0.0,  190.00000, 
-12.71400,  -12.64500, 
-12.46200,  -12.43100, 
-12.34500,  -12.33000, 
-12.28600,  -12.27700, 
-12.25300,  -12.24800, 
-12.23300,  -12.23000, 

{0.0,  200.00000, 
-12.90400,  -12.82700, 
-12.61700,  -12.58200, 
-12.48100,  -12.46300, 
-12.41000,  -12.40100, 
-12.37100,  -12.36600, 
-12.34800,  -12.34400, 

{0.0,  210.00000, 
-13.08500,  -13.00000, 
-12.76400,  -12.72400, 
•12.60800,  -12.58700, 
-12.52600,  -12.51500, 


-11.72100,  -11.71700, 
-11.70500,  -11.70200, 
-11.69300,  -11.69100}, 


-11.99300,  -11.96600, 
-11.89200,  -11.88000, 
-11.84400,  -11.83700, 
-11.81700,  -11.81300, 
-11.80000,  -11.79700, 
-11.78800,  -11.78600}, 


-12.20700,  -12.17200, 
•12.08000,  -12.06400, 
-12.02000,  -12.01200, 
-11.98800,  -11.98300, 
-11.96800,  -ll.%500, 
-11.95500,  -11.95300}, 


-12.40400,  -12.36200, 
-12.24900,  -12.23000, 
-12.17500,  -12.16600, 
-12.13700,  -12.13100, 
-12.11400,  -12.11100, 
-12.09900,  -12.09700}, 


-12.58800,  -12.53900, 
-12.40500,  -12.38200, 
-12.31700,  -12.30500, 
-12.27000,  -12.26400, 
-12.24400,  -12.24000, 
-12.22700,  -12.22400}, 


-12.76200,  -12.70600, 
-12.55100,  -12.52400, 
-12.44700,  -12.43300, 
•12.39200,  -12.38400, 
-12.36100,  -12.35600, 
-12.34100,  -12.33800}, 


-12.92700,  -12.86400, 
-12.68900,  -12.65800, 
-12.56900,  -12.55300, 
-12.50500,  -12.49500, 


11.71400, 

11.70000, 


11.94300, 

11.86900, 

11.83100, 

11.80900, 

11.79500, 


12.14300, 

12.05100, 

12.00500, 

11.97900, 

11.96200, 


12.32700, 

-12.21300, 

12.15700, 

-12.12600, 

12.10800, 


12.49800, 

12.36200, 

12.29500, 

12.25800, 

12.23600, 


12.65800, 

12.50100, 

12.42100, 

12.37700, 

12.35200, 


12.81100, 

12.63200, 

12.53900, 

12.48700, 


jacdat.c 


jaedat.c 


ftrc44[31] 


ftrc45[31] 


far  c46[3I] 


for  c47(31] 


for  c48[31] 


for  c49[31] 


-12.48000,  -12.47300. 
-12.43200,  -12.44800. 

{0.0,  220.00000, 
-13.25800,  -13.16400, 
-12.90400,  -12.83900, 
-12.72900.  -12.70300, 
-12.63300,  -12.62100, 
-12.38100,  -12.37300, 
-12.54900,  -12.54400, 

{0.0,  230.00000. 
-13.42200,  -13.32100, 
-13.03800,  -12.98900, 
-12.84400,  -12.81700, 
-12.73700,  -12.72200, 
-12.67600,  -12.66700, 
-12.63800,  -12.63200, 

{0.0,  240.00000, 
-13.38100,  -13.47200, 
-13.16700,  -13.11300, 
-12.95300,  -12.92400. 
-12.83300,  -12.81800, 
-12.76500,  -12.75500, 
-12.72200,  -12.71500, 

{0.0,  250.00000, 
-13.73300,  -13.61700, 
-13.29000,  -13.23200, 
-13.03900,  -13.02700, 
-12.92800,  -12.90900, 
-12.85000,  -12.83800, 
-12.80100,  -12.79300, 

{0.0,  260.00000, 
-13.88100,  -13.75800, 
-13.40900,  -13.34700, 
-13.16000,  -13.12600, 
-13.01800,  -12.99700, 
-12.93100,  -12.91800, 
-12.87600,  -12.86700, 

{0.0,  270.00000, 
-14.02400,  -13.89400, 
-13.32400,  -13.45800, 
-13.25900,  -13.22100, 
-13.10400,  -13.08100, 
-13.00900,  -12.99400, 
-12.94700,  -12.3800, 


-12.46700,  -12.46200, 
-12.44400,  -12.44100}, 


-13.08400,  -13.01500, 
•12.82000,  -12.78600, 
-12.68400,  -12.66600, 
-12.61000,  -12.59900, 
•12.56600,  -12.56000, 
-12.33900,  -12.53500}, 


•13.23400,  -13.16000, 
-12.94500,  -12.90700, 
-12.79400,  -12.77300, 
-12.70900,  -12.69700, 
-12.65900,  -12.65100, 
-12.62700,  -12.62200}, 


-13.37900,  -13.29800, 
-13.06500,  -13.02300, 
•12.89800,  '12.87500, 
•12.80300.  -12.78900, 
-12.74500,  -12.73700, 
-12.70900,  -12.70400}, 


•13.51800,  -13.43100, 
-13.18100.  -13.13500, 
-12.99800,  -12.97200, 
-12.89200,  -12.87700, 
-12.82800,  -12.81800, 
-12.78600,  -12.78000}, 


•13.63200,  -13.56000, 
-U.29XO,  -13.24300, 
•13.09400.  -13.06600, 
-12.97800,  -12.96100, 
-12.90600,  -12.89500, 
-12.85900,  -12.85200}, 


•13.78200,  -13.68400, 
-13.39900,  -13.34700, 
-13.18700,  -13.15700, 
-13.06000,  -13.04200, 
-12.98100,  -12.96900, 
12.92900,  -12.92000}, 


-12.45700, 


12.95600, 

12.75300, 

12.64900, 

12.59000, 

12.55400, 


-13.09500, 
12.87300, 
12.75400, 
12.68600, 
-12.64400, 


13.22800, 

12.98600, 

12.85400, 

12.77600, 

12.72900, 


-13.35600, 

-13.09500, 

12.94900, 

-12.86300, 

12.80900, 


13.48000, 

13.19900, 

13.04100, 

-12.94500, 

12.88500, 


-13.59900, 
-13.30000, 
-13.12900, 
-13.02400, 
-12.95800, 


jacdat.c 


jacdat.e 


fivcS0(31] 


ikrc5I[3I] 


far  cS2[31] 


far  cS3[3i] 


hr  c54[31] 


fiu-  c55[31] 


for  c56[31] 


{0.0.  280.00000, 
•14.16400,  -14.02600, 
-13.63600,  -13.56600, 


-13.35300, 

-13.18700, 

-13.08400, 

-13.01600, 


-13.74400, 

-13.44600, 

-13.26800, 

-13.15600, 

-13.08200, 


-13.85000, 

-13.53500, 

-13.34600, 

•13.22600, 

•13.14600, 


-13.42300, 


•14.05300, 

-13.70700, 

-13.49700, 

-13.36100, 

-13.26800, 


-14.82100, 

-14.15200, 

-13.79100, 

-13.57000, 

-13.42600, 


-13.31300, 

-13.16300, 

•13.06800, 


-13.90800, 

•13.50400, 

-13.27700, 

-13.14000, 

-13.05300, 

-12.99500, 


-14.03000, 

-13.60500, 

-13.36400, 

-13.21700, 

-13.12300, 

-13.05900, 


-14.15000, 

-13.70300, 

-13.44900, 

-13.29200, 

-13.19000, 

-13.12100, 


-14.26800, 

-13.79900, 

-13.53100, 

-13.36500, 

-13.25600, 

-13.18100, 


-14.38300, 

-13.89200, 

•13.61200, 

•13.43600, 

-13.32000, 

-13.23900, 


-14.49600, 

-13.98400, 

-13.69000, 

-13.50500, 

-13.38200, 

-13.29600, 


-14.60700, 


-13.80500, 

-13.44800, 

-13.24400, 

-13.12000, 

-13.04000, 

-12.98600}, 


-13.92200, 

-13.54600, 

-13.32900, 

-13.19500, 

-13.10800, 

-13.04900), 


-14.03700, 

-13.64100, 

-13.41100, 

-13.26800, 

-13.17400, 

•13.11000}, 


-14.14900, 

-13.73400, 

-13.49200, 

-13.34000, 

•13.23900, 

-13.16900}, 


-14.25800, 

-13.82400, 

-13.57000, 

-13.40900, 

-13.30100, 

-13.22600}, 


-14.36600, 

-13.91300, 

-13.64700, 

-13.47700, 

-13.36200, 

-13.28200}, 


-14.47200, 


-13.00500, 

{0.0,  290.00000, 
-14.30000, 


{0.0,  300.00000, 
•14.43400, 


{0.0,  310.00000, 
-14.56500,  -14.40500, 
-13.95300,  -13.87100, 
•13.62200,  -13.57500, 


-13.29400, 
-13.20800, 

{0.0,  320.00000, 
-14.69400, 


{0.0,  330.00000, 


-13.32700,  -13.31100, 

{0.0,  340.00000, 
•14.94700,  -14.76400, 


-14.15500, 

-13.67000, 

-13.40300, 

-13.24200, 

-13.13900, 

-13.07000, 


-14.28100, 

-13.77200, 

-13.49000, 

-13.31800, 

•13.20800, 

•13.13300, 


-13.39300, 

-13.27400, 

•13.19400, 


-14.52700, 

-13.96800, 

-13.65700, 

-13.46500, 

-13.34000, 

-13.25300, 


-14.64600, 

-14.06300, 

-13.73800, 

-13.53600, 

-13.40300, 


-13.71500, 

-13.39800, 

13.21400, 

13.10100, 

13.02700, 


13.82800, 
13.49300, 
13.29700, 
13.17500, 
-13.09400, 


13.93700, 

13.58500, 

-13.37700, 

13.24600, 

13.16000, 


-14.04400, 
-13.67500, 
-13.45600, 
-13.31600, 
-13.22300, 


-14.14900, 
-13.76300, 
-13.53200, 
-13.38400, 
-13.28400, 


-14.25200, 
-13.84900, 
13.60700, 
-13.45000, 
-13.34400, 


14.35300, 


jacdat.c 


jacdat.c 


fir  cS7[31] 


ftr  cS8[31] 


for  cS9[31] 


fitf  c60(31] 


fiu-  c61[31] 


c62C31] 


-14.24900,  -14.13600, 
•13.87200,  -13.81700, 
-13.64100,  -13.60600, 
•13.48900,  -13.46500, 
-13.38400,  -13.36700, 

{0.0,  350.00000, 
-15.07000.  -14.88000. 
-14.34400,  -14.24700, 
-13.95200,  -13.89400, 
-13.71100,  -13.67300, 
-13.55100,  -13.52600, 
-13.44000,  -13.42200, 

{0.0,  360.00000, 
-15.19200,  -14.99500, 
-14.43700,  -14.33700, 
-14.03000,  -13.97000, 
-13.77900,  -13.74000, 
-13.61200,  -13.58500, 
-13.49500,  -13.47600, 

{0.0,  370.00000. 
-15.31300,  -15.10900, 
-14.53000,  -14.42600. 
•14.10700,  -14.04500, 
-13.84600,  -13.80500, 
•13.67100,  -13.64400, 
-13.54900,  -13.52900, 

{0.0,  380.00000, 
-15.43100,  -15.22100, 
-14.62000,  -14.51300, 
-14.18200,  -14.11800, 
-13.91100,  -13.86900, 
-13.73000,  -13.70100, 
-13.60200,  -13.58100, 

{0.0,  390.00000, 
-15.54800,  -15.33100, 
-14.71000,  -14.59900, 
-14.25600,  -14.19000, 
-13.97600,  -13.93200, 
-13.78700,  -13.75700, 
-13.65400,  -13.63200, 

{0.0,  400.00000, 
-15.66200,  -15.44000, 
•14.79900,  -14.68400, 
-14.33000,  -14.26100, 


-14.07300,  -13.99900, 
-13.76700,  -13.72100, 
-13.57300,  -13.54300, 
•13.44300,  -13.42200, 
-13.35100,  -13.33600}, 


-14.71700,  -14.57600, 
-14.16100,  -14.08400, 
•13.84200,  -13.79400, 
-13.63900,  -13.60800, 
-13.50200,  13.48000, 
-13.40500,  -13.38900}, 


-14.82600,  -14.67900, 
•14.24800,  -14.16800, 
-13.91600,  -13.86600, 
-13.70400,  -13.67100, 
-13.56000,  -13.53700, 
-13.45800,  -13.44100}, 


•14.93300,  -14.78000, 
•14.33300,  -14.25000, 
-13.98800,  -13.93700, 
-13.76«)0,  -13.73300, 
-13.61800,  -13.59300, 
-13.51000,  -13.49200}, 


-15.03800,  -14.88000, 
-14.41700,  -14.33000, 
-14.05900,  -14.00600, 
-13.83100,  -13.79500, 
-13.67400,  -13.64800, 
-13.56100,  -13.54200}, 


-15.14300,  -14.97900, 
-14.49900,  -14.41000, 
-14.12900,  -14.07400, 
•13.89200,  -13.85500, 
-13.72900,  -13.70200, 
-13.61100,  -13.59200}, 


-15.24600,  -15.07700, 
-14.58100,  -14.48800, 
-14.19800,  -14.14100, 


13.93200, 

13.67900, 

13.51500, 

13.40200, 


-14.45200, 
14.01500, 
-13.75100, 
13.57800, 
-13.46000, 


-14.55000, 

14.09500, 

-13.82100, 

-13.64000, 

13.51600, 


14.64700, 

-14.17500, 

13.88900, 

13.70100, 

13.57100, 


14.74200, 
14.25200, 
-13.95700, 
-13.76100, 
-13.62400, 


14.83600, 
14.32900, 
14.02300, 
13.82000, 
13.67700, 


-14.92900, 
-14.40500, 
-14.08800, 


jacdat.c 


jacdat.c 


-14.03900,  -13.99400, 
-13.84400,  -13.81300, 
-13.7OS00,  -13.68200, 

c63(31]  s  {  0.0,  420.00000, 

-15.88400,  -15.65400, 
-14.97400,  -14.85100, 
-14.47300,  -14.40000, 
-14.16300,  -14.11500, 
-13.95400,  -13.92100, 
-13.80500,  -13.78000, 

c64[31]  =  {0.0,  440.00000, 

-16.09400,  -15.86000, 
-15.14500,  -15.01400, 
-14.61300,  -14.53500, 
-14.28400,  -14.23300, 
-14.06200,  -14.02600, 
-13.90200,  -13.87500, 

c65[31]  s  (0.0,  460.00000, 

•16.29000,  -16.05700, 
•15.31200,  -15.17400, 
•14.75000.  -14.66800, 
-14.40200.  -14.34700, 
•14.16600,  -14.12800, 
•13.99600,  -13.96800, 

far  c66{31]  =>  {  0.0,  480.00000, 

•16.46800,  -16.24400. 
-15.47700,  -15.33200, 
-14.88400,  -14.79700, 
-14.51700,  -14.45900, 
-14.26800,  -14.22700, 
-14.08800,  -14.05800, 

*cc{671  = 

{ 


-13.95200,  -13.91400,  -13.87800, 
-13.78300,  -13.75500,  -13.73000, 
-13.66000,  -13.64000}, 


-15.44900.  -15.27000,  -15.11200, 
-14.74100,  -14.64200,  -14.55300, 
-14.33300.  -14.27200,  -14.21500, 
-14.07100,  -14.02900,  -13.99000, 
•13.88900,  -13.85900,  -13.83100, 
-13.75700,  -13.73400}, 


-15.64700,  -15.45800,  -15.29200, 
-14.89700,  -14.79300,  -14.69800, 
-14.46400,  -14.39900,  -14.33900, 
-14.18500,  -14.14100,  -14.10000, 
•13.99200,  -13.96000,  -13.93000, 
-13.85000,  -13.82600}, 


•15.83900,  -15.64200,  -15.46700, 
-15.05100,  -14.94000,  -14.84000, 
-14.59^,  -14.52400,  -14.46000, 
-14.29700,  -14.25000,  -14.20700, 
-14.09200,  -14.05800,  -14.02600, 
•13.94100,  -13.91500}, 


-16.02400,  -15.82100,  -15.63900, 
•15.20200,  -15.08500,  -14.98000, 
-14.71800,  -14.64500,  -14.57800, 
•14.40600,  -14.35700,  -14.31100, 
-14.18900,  '14.15300,  -14.12000, 


-14.02900,  -14.00200}, 


cl,  cl,  c2,  c3,  c4,  c5,  c6,  c7,  c8,  c9,  clO,  cll,  cI2,  cl3, 
cl4,  cl5,  cl6,  cl7,  cl8,  cl9,  c20,  c21,  c22,  c23,  c24,  c25,  c26,  c27, 

c28,  c29,  c30,  c31,  c32,  c33,  c34,  c35,  c36,  c37,  c38,  c39,  c40,  c41, 

c42,  c43,  o44,  o45,  c46,  c47,  c48,  c49,  c50,  c51,  c52,  c53,  c54,  c55, 

c56,  c57,  c58,  c59,  c60,  c61,  o62,  c63,  c64,  c65,  c66 


* - - - */ 

void  jacciiia  data(double  D[68](31]) 

{ 
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int  ij; 


/*_ - — 

*/ 

for(i*0  ;  i<«66  ;  i++) 

{ 

foi<j»0  ;  j<*29  ;  j++) 

{ 

D(i+lllj+ll  *  ccPlOl; 

} 

} 
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This  is  the  ftmctioo  coiiipute_nip 


jKnclude  <iiisth.h> 
#iiicltide  'rapmSO.h* 
iKnciude  "rnpd.h* 


void  coiiipute_nip  (feferBiice_iiiput,  epoch_bput,  mSO) 

RNP_REFERENCE  '*feference_iiiput; 

EPOCH_REF  '*'q>och_input; 

RNP  *11150 ; 


void  precession_geoef«torO  ; 
void  nutsdoo _2eaerator0  ; 
void  rotation _generstorO  ; 

/* - // 

//  Include  static  data  required  for  the  mp_mS0  function.// 


double  T,  TU,  angle_niodulo  Q  : 
double  argument; 

double  centuries_midnight_from_1900_utl; 
double  centuries_ref_siace_1900_tdt; 
double  centuries_ref_since_1950_trop; 
double  coef; 

double  greeawich_niean_siderial_time_ref; 

double  interim_aigumeat; 

double  juUan_date_inidnight_tdt; 

double  julian_date_inidoight_utl; 

double  julian_date_tdt; 

double  julian_date_utl; 

double  mean_angle[7]; 

double  8econds_epoch_since_iiudnight_utl; 

double  t_cubed; 

double  t_aquared; 

double  temp; 

mt  i; 
int  j; 
int  1; 
int  m; 

double  nutation_precession[4][4]; 
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/* - // 

//  Get  a  copy  of  the  releretice  epoch  and  the  // 

//  EPOCH  REF  atnicture  into  the  RNP  structure.  H 

U - 1 - */ 

mSO->refisrence  «■  *refBreiice_input; 
iiiSO->epoch  s  '''epoch_uiput; 

/* - // 

//  Compute  the  time  parameters  in  the  TOT  and  UTI  time  scales.  II 

n - */ 

if(m50->q>och.time  scale  ==  TOT) 

{ 

julian_date_tdt  =  mSO->epoch.julian_date; 
julian_date_utl  s  iiiSO->qpoch.julian_date 

-  mSO->q)och.delta_time_tdt_utl  /  DAY; 

julian_date_midnight_tdt  =  mSO->  epoch. julian_date_midnight; 
julian_date_midnight_utl  »  mSO->  epoch. julian_date_midnight 

-  mSO->epoch.delta  time_tdt  utl  midnight  /  DAY; 

} 

else 

{ 

julian_date_tdt  —  mSO'>epoch.julian_date 

+  niSO->epoc^.delta_time_tdt_utl  /  DAY; 
julian_date_utl  s  mSO*>epoch.juIian_date; 

ju]iao_date_niidnigbt_tdt  s  niSO->epoch.jolian_date_midnight 

+  mSO->q>och.delta_time_tdt_utT_midni^t  /  DAY; 
ju]ian_date  midnight  utl  s  niSO->q>och.julian  date  midnight; 

}  '  ■ 
centuries_midnight_firom_1900_utl  s 

Julian  date  midnight  utl  -  JULIAN  DATE  1900)  / 

JUUAN_CENTURYr 

seconds_epocb_since_midnight_utl  »  (julian_date_utl 

-  julian_date_midnight_utl)  *'  DAY; 

/* - // 

//  Conqjute  Greenwich  mean  i^idereal  time  at  nudnight  in  seconds.// 

// - */ 

TU  =  centuries_midnight_firom_1900_utl  ; 
t_squared  =  TU  *  TU; 


temp  *  gmst_ut_reIation_ddot  *  TU; 

mSO->greeowich_mean_siderial_tiine_inidiught  ^  gmst_ut_relation_const 
+  gniat_ut_relation_dot  "■  TU 
+  temp  *  TU; 
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/* - // 

H  Ratio  of  sidorial  to  aolar  time  in  // 

//  revolutions  per  mean  solar  day.  // 

// - •/ 

mSO->ratio_siderial_to_solar_time  »  (DAY 

+  (2  *  temp  +  gmst_ut_relation_dot)  /  AJLIAN_CENTURY)  /  DAY; 

/* - // 

//  Compute  Greenwich  mean  sidereal  time  at  epoch  in  seconds.// 

// - ■*/ 


m50->greenwich_mean_siderial_time  » 

mSO-  >  greenwich_mean_si(kriai_time_midnight 
+  (m50->rBtio_siderial_to_solar_time 
*  sec(Mids_epoch_since_midnight_utl); 

mSO->greenwich_mean_siderial_time_midnight  = 

angle_moduio  (  m50->greenwich  mean  siderial  time  midni^t 
*  RAD_PER_SEC_TiME  );“ 
m50->gremiwich_mean_sideriai_time  s 

angle  modulo  (  mSO->greenwich  mean_sidMial  time 
•  RAD_PER_SEC_TIME  );  ~ 

/* - // 

//  Convert  the  ratio  of  siderial  to  solar  // 

//  time  from  revolutions  to  radians.  // 

// - */ 

mSO->ratio_sideriai_to_aoiar_time  *=*  TWO_H; 

/* - // 

//  Set  the  time  since  the  desired  reference  since  the  MSO  epoch  // 

//  in  centuries  and  the  reference  Greenwich  mean  sicferial  time.  // 

// - ■*/ 

if(  mSO->referaice  **  AT  EPOCH  ) 

{ 

centuries  ref  since  19(X)  tdt  — 

OuUanJdateJ^t  -  JUUAN_DATE_I900)/JULIAN_CENTURY; 
centuries  ref  since  1950  trop  b 

0'uliu_^_tdt  -  JUUAN_DATE_I950)/TROPICAL_CENTURY; 
greenwich_mean_sideriai_time_ref  ^ 

mS0->greenwich  mean  siderial_time; 

} 

else 

{ 

centuries_ref_8ince_1900_tdt  * 

(juiian_date_midnight_tdt  -  JULIAN_DATE_1900) 
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/  JUIJAN_CENTURY; 

ceotiiries_f«f_ttfioe_1950_trop  » 

(juUiui  date  nudni^  tdt  -  JULIAN  DATE_1950) 
/  TROPICaL_CENTURY; 
gneowich_oiean_aiderial_tiiDe_ief  » 

m50~> gnmwkhjBcui  aiderial  time  midni^t; 

} 


/* - // 

//  Evaluate  meaD_aagie  from  one  to  aevea  terms  dq>eodmg  on  the  // 
//  value  of  poly  index  after  initialziBg  the  mean  an^e  array  to  0.// 

// - 1 - 1 - */ 

T  »  centuries_ref_tince_1900_tdt; 

for(i  »»  0;  i  <  7;  ++i) 

{ 

mean  angle[i]  «  0.0; 

) 

t_squaied  *  T  *  T; 
t  cubed  «  t  squared  *  T; 

~for(i  »  0;  f<  MEAN  ANGLE  INDEX;  +  +i) 

{ 

mean_^angle(i]  »=  (  mean_angle_coef[i][0] 

+  mean_angle_coef[i][l]  *  T 
+  mean_angle_coef[i][2]  t_squared 
-f  mean  angle  coef[i][3]  *  t  cubed  ) 

•  ARC  SEC;  " 

} 

mS0->mean_obUquity  b  mean_angle[0]; 

/*. - // 

//  Compute  the  nutation  in  longitude.// 

// - */ 

mSO->nutation_inJ<Migitude  s  0.0; 
forO  »  0;  j  <  mode  limits[0];  +  +j) 

{ 

/* - // 

//  Since  original  ca,  cb,  Iongitude_lib_coef,  inclinationJib_coef,// 

//  node_Ub_coef  were  in  six  character  literal  strings  increment,  // 

//  counter  nuist  be  advanced  by  six  each  time  through  loc^.  // 

// - */ 


m  ■*  j  *  6; 


if(i  <  dimension[l][0]) 

{ 
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coef  »  adotQ]  *  T  +  «[j]: 

} 

else 

{ 

coef  =  a(j]; 

} 

argument  s  0.0; 

forO  »  0;  1  <*  data  incremeot[0];  ++1) 

{ 

if(l  !=  0)  ++m: 

uiterim_argument  =  ca[m]; 
if(interim_argumeot  !—  0) 

{ 

if(  mterim_argument  >  =  4  ) 

{ 

interim_argument  -=  7; 

} 

argument  +==  interim  argument  '*  mean  angleH+l]; 

} 

} 

mSO->outation_in  longitude  +=  coef  *  sin(argument); 

} 


/m - // 

//  Compute  the  nutation  of  obliquity.  // 

// - */ 

mS0->nutation_of_obliquity  0.0; 
for(j  =  0;  j  <  mode_iimits[l];  ++j) 

{ 


/* - .// 

//  Since  original  ca,  cb,  longitude_lib_coef,  inclination_lib_coef,// 

//  node_lib_coef  were  in  six  character  literal  strings  increment,  // 

//  counter  must  be  advanced  by  six  each  time  through  loop.  // 

// - */ 


m  =  j  *  6; 

ifQ  <  dimeosion[l][l]  ) 

{ 

coef  «=  bdot[j]  "■  T  +  bOJ; 

} 

else 

{ 

coef  =  bOJ; 
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} 

argument  =  0.0; 

for(I  ac  0;  I  <«  data  inciemeat(l];  ++I) 

{ 

if  0  !=  0)  ++m; 

inteiiffl_aig|ument  »  cb[m]; 
if(iaterim  atpiment  !«  0) 

{ 

if(interim  argument  >  »  4) 

{ 

interim_argument  7; 

> 

argument  +=  interim  argument  *  mean  angleH+I]; 

} 

} 

mSO->nutation_of_obIiquity  +=  coef cos(argument); 


/* - // 

//  Produce  the  true  greenwich  hour  angle  by  addmg  the  equation  of  // 

H  the  equinoxes  to  the  mean  hour  angle  calculated  previously.  // 

// - •/ 

mS0->nutation_of_obliquity  ♦=  ARC_SEC; 
mS0->true_obliquity  =  m50->mean_obliquity  +  m50->nutation_of_obliquity; 

mSO->equation_of_equinoxes  s  mS0->nutatioa_in_Iongitude 
*  cos  (m50->tiue_obliquity); 
mS0->nutation_in_longitude  '•'=  ARC_SEC; 

m50- >  greenwich_app_sidcrial_time_ref  =  angie_modulo  ( 
greenwich_mean_siderial_time_ref 

+  m50->equation_of_equinoxes  *  ARC_SEC  ); 


I* - // 

//  Conqpute  the  following  precession  angles:  // 

//  // 
//  zeta  Negative  of  the  right  ascension  of  the  mean  // 

//  celestial  pole  of  date  (Z-MOD  axis)  refered  // 

//  to  the  mean  equator  and  pole  of  interest.  // 

//  // 

//  theta  The  complement  of  the  declination  of  the  mean  // 

//  celestial  pole  of  data  refered  to  the  mean  equator  // 

//  and  pole  of  mterest.  // 

//  // 

//  z  The  negative  of  the  supplemmt  of  the  right  // 
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//  ascension  of  the  mean  celestial  pole  of  date  // 

//  refered  to  the  mean  equator  and  pole  of  interest.  // 

// - */ 


t_squared  s  centuries_ref_since_19S0_tr(q> 

*  ccnturies_ref_8ince_l950_trop; 

t_cubed  *=  t_squared  *  centuries_ref_since_I950_lrop; 

m50->zeta  =  (  precession_coef[0]  *  centuries_ref_since_1950_trop 
+  precession_coef[l]  *  t_squared 

+  precession_coef[2]  *  t_cubed  )  *  ARC_SEC; 

mSO->  theta  =  (  precession_coef[3]  ■"  centuries_ref_since_1950_trop 
+  precession_coef[4]  t_squared 
+  precession_coef[5]  *  t_cubed  )  *  ARC_SEC; 

m50->z  =*  (  precession_coef[6]  *  centuries_ref_sincc_1950_trop 

+  precession_coef[7]  *  t_squared 

+  precession_coef[8]  *  t_cubed  )  ARC_SEC; 


//  Calculate  the  precession  matrix.// 

precession_;generator  (  mSO->zeta,  mSO->dieta,  m50*>z,  mSO*>  precession); 

//  Calculate  the  nutation  matrix.// 

// - */ 

nutation_genenitor  (  mSO->mean_obliquity, 

mSO-  >  nutation_inJongitude, 
ni50-  >  true_obliquit>',mSO-  >  nutation); 


/* - n 

1 1  Calculate  the  mSO_matrix  by  premultiplying  the  precession  matrix  // 
//  by  the  nutation  matrix,  and  then  premultiplying  that  matrix  with  // 

//  the  rotation  matrix.  // 

// - */ 

matrix_x_matrix  (  m50->  nutation, 
m50-  >  precession, 
nutation jpncession  ); 

rotation_generator  (  ni50*>greenwich_iq)p_siderial_time_ref, 
mSO->  rotation); 

niatrix_x_inatrix  (  ni50->  rotation,  nutati<m_precessioo,  niSO->mp); 
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} 


/*  This  is  the  function  */ 

/*  Input  ai:gunients  are  - 


*/ 


/* 


*/ 


/*  Return  arguments  are  •  */ 

fmmrinif************************************************************************/ 


*! 


void  precession^geaeratorfzeta,  theta,  z,  precession) 
double  precession[4][4]; 

double  zeta;  I*  Negative  of  the  right  ascension  of 

//  the  mean  celestial  pole  of  date 
//  (Z-MOD  axis)  refered  to  the  mean 
//  equator  and  pole  of  interest.  *! 

double  theta;  I*  The  complement  of  the  declination 

//  of  the  mean  celestial  pole  of  data 
//  (Z-MOD  axis)  refered  to  the  mean 
//  equator  and  pole  of  interest.  *! 

double  z;  I*  The  negative  of  the  supplement  of 

//  the  right  ascension  of  the  mean 
//  celestial  pole  of  date  (Z-MOD  axis) 
//  refered  to  the  mean  equator  and 
//  pole  of  bterest.  *! 

double  c_theta_c_z; 
double  c_theta_s_z; 
double  co8_theta; 
double  cos_z; 
double  cos_zeta; 
double  sin_theta; 
double  sin_z; 
double  sin  zeta; 


/♦ - // 

//  ConqHite  the  sines  and  cosines  of  the  Z-MOD  axis  pole  angles.// 

U - 


cos_zeta  s  cos(  zeta  ); 
sin_zeta  «  8in(  zeta  ); 

cos_theta  »  cos(  theta  ); 
sin_theta  «  8in(  theta  ); 

COS_Z  as  cos(  z ); 
sin_z  =  8in(  z  ); 
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c_theto_c_z  *  cos_theta  co8_z; 
c_tlieU_s_z  =  cos_tlieta  '*  sin_z; 

/* - // 

//  Compute  the  precession  ntstrix.// 

// - */ 


precession[l][l]  =  cos_z^  •  c_thets_c_z  -  sin_zeta  *  sin_z; 
preoession[I][2]  *  -  sm_2eta  c_theU_c_z  -  cos_zets  *  sin_z; 
precessioo[l][3]  =  -  sin_thets  *  cos_z; 

precession[2][l]  =  cos_zbU  *  c_thets_s_z  +  sin_zeta  *  cos_z; 
precession[2][2]  =  -  sin_zeta  c_theta_s_z  +  cos_zeta  *  cos_z; 
precession[2][3]  =  -  sin_theta  sin_z; 


} 


precession[3][l]  = 
precession[3][2]  « 
precession[3][3]  s 


cos_zeta  sin_thets; 
sin_zeta  *  sin_theta; 
cos  theta; 


/*  This  is  the  iimction  */ 

/*  Input  arguments  are  •  */ 

I*  */ 


/*  Return  arguments  are  •  */ 

void  nutation_generator  (mean_obliquity,  nutation_in_longitude, 

tnie_obiiquity,  nutation) 


double  mean_obliquity; 
double  nutation_in_longitude; 
double  tnie_obliquity; 
double  nutation[4][4]  ; 

double  c_true_obliq_c_nutJong; 
double  cos_mean_obliq; 
double  cos_nutation_in_long; 
double  cos_true_obliq; 
double  s_true_obliq_c_nut_long; 
double  sin_mean_obliq; 
double  sin_nutation_in_long; 
double  sin_true_obliq; 


/* - // 

//  Conqwte  the  sines  and  cosines  of  the  nutation  angles.  // 

// - */ 


cos_true_obliq  =  cos(true_d>liquity); 
sin_true_obliq  *  sin(tnie_obliquity); 

co8_nutation_in_long  «  co8(nutation_inJongitude); 
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•in_niitation_in_long  »  sin(nutatioii_iii_longitude): 

cos_inean_obUq  »  cos(aiean_obliqiiity); 
sin_meaii_obliq  «  sin(iDeaii_obUquity); 

c_tnie_obUq_c_nut_Iong  »  cos_tnie_obUq  *  co»_DUtatioa_iii_loog; 
s_tnie_obliq_c_nut_Iong  =  sin_tnie_obUq  ♦  cos_nutaUoD_in_Iong; 


/* - // 

//  Compute  the  nutaticm  matrix.// 
// - */ 


nutation[l][l]  s 

cos_nutation_in_l<mg: 

nutation[l][2]  = 

-  cos_mean_obliq  *  sin_nutation_in_long; 

nutation[l][3]  = 

-  sin_mean_obliq  sin_nutation_in_long; 

nutation[2Kl]  ^ 

cos_tnie_obliq  *  sin_nutation_inJong; 

nutation[2][2]  « 

cos_mean_obliq  "■  c_tfue_obliq_c_nut_long 

nutation[2][3]  ^ 

+  ain_mean_obliq  *  sin_true_obliq; 
8in_mean_obliq  *  c_true_obliq_c_nut_long 

nutation[3][l]  — 

•  cos_niean_obiiq  *  8in_true_obliq; 

sin_tfue_obliq  *  sin_nutation_in_long; 

nutati<m[3][2]  - 

co8_mean_obliq  *  8_true_crf)liqL.c_nut_long 

nutation[3](3]  >= 

-  sin_mean_obliq  cos_true_obliq; 
sin_mean_obliq  "■  s_true_j*liq_c_nut_long 

+  cos  mean  obliq  *  cos  true  obliq; 

} 

/4ii|i4i*iti4i4i4i4i4i«4i>ti4i4i4i4ii^4ii)ii»4i4i4iiti4i4i4i4ii^4i4i4i4>4ii|i4ii|i4i4i4i4i4i4i4i4i4i4u^4i4ii<ii»«iti4i4i4n*i»iti4i4i4i4i4iiti4i4i4i4i4i4,4i4i4i^ 

/*  This  is  the  Auction 

*1 

/*  Input  arguments  are  * 

*1 

!* 

*1 

!*  Return  arguments  are  - 

*/ 

void  Tctation _geiierator(greenwich_iq>p_8ideria]_time,rotation) 

double  greenwich  app  siderial  time,  rotation[4][4]  ; 

{ 

double  cos_jfeenwich_a|q)_siderial_time; 
double  sin _jreeowich_app_siderial_time; 

/* - // 

//  Compute  the  sine  and  cosine  of  the  gfeewich  // 

//  apparent  siderial  time  angle.  // 

// - */ 

cos _gieenwich_qq)_siderial_time  »  cos  (  greenwich_app_siderial_time  ); 
sin _greenwich_qq>_siderial_time  »  sin  (  greenwich_app_siderial_time  ); 

/* - // 

//  Conqpute  the  rotation  matrix.  // 
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// - */ 

roUtion[I][l]  s  cos _sreeawich_iq)p_8iderul_tiiiK; 
rotsUon[I][2]  sm _,greenwich_app_sideria]_tiine; 
roUtton[l][3]  »  0.0; 

roUtioa[2][l]  —  -sin _gnenwich_app_siderial_tiiDe; 
rDUtioo[2][2]  »  cos _greenwich_spp_sideris]_tiine; 
rotation[21[3]  s  Q.O; 

rouaion[3][l]  »  0.0; 
rotstion[3][2]  —  0.0; 
n)Ution(3]I3]  =  1.0; 

} 

^i|i4i4ii|i4i4i4ii|i4i4i4i4i4i^4i4i4i4i4ii^4i4i4i4i4i4ii^4i4ii^4i4i^4i4M^4i4i4i4i4i4i4i4i4i4i4i4i4i4i4i4i4i4i4i4i4i4i4i«4i4i4i4i4i4i4i4i4ii»Mi4i4ii|i4iy 

double  sngle_moduio(  angle  ) 
double  angle; 

{ 

int  revolutions; 

revolutions  —  (int)  (  fabs(  angle  )  /  TWO  PI  ); 
if(  angle  >  TWO  H  ) 

{ 

retum(  angle  -  (double)  revolutions  •  TWO  W  ); 

} 

else  if(  angle  <  0.0  ) 

{ 

retuni(  angle  +  (double)  (  revolutions  -i-  1  )  *  TWO  FI  ); 

} 

else 

{ 

return  ( angle  ); 

} 

} 
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This  is  the  Ruofe-Kutta  foiuth  order  iolegntor. 

Input  argumeots  are  > 

tz  B  current  time  in  seconds 

x2(8]  *  initial  state  array  consisting  of  the  foilowbg  elements  - 
xz(0]  »  not  used 
xz[l]  B  position  in  x  (km) 
xz(2]  »  position  in  y  (km) 
xz[3]  «  position  in  z  (km) 
xz(4]  K  velocity  in  x  (km/s) 
xz(S]  s  velocity  in  y  (km/s) 
xz(6]  ■*  velocity  in  z  (km/s) 
xz(7]  *  magnitude  of  position  vector  (km) 
stq>  s  time  step  size  in  seconds 
Return  arguments  are  • 

x[8]  s  final  state  array  consisting  of  the  same  elements  as  xz{8] 
with  x[7]  a>  rdot 


Runge-Kutta  is  called  by  ’Cowell’ 

Runge-Kutta  calls  ’Derivatives’ 

m^0m*m***********<Mf************'nm*************m**i>**M*************‘*********/ 

iKnclude  <oitMnechl.h> 

#include  ’iers.h" 

#inciude  "mpmSO-h" 

void  Runge  Kutta  4(tz,  xz,  jd  midnight,  mSO,  P,  lERS,  step,  x) 


double  tz; 
double  xz[8]; 
double  jd^midnight; 
double  stq>; 
double  x[8]; 

Perturbations  "'P  ; 

struct  lERS  DATA  *IERS  ; 

RNP  *inM  ; 

{ 

int  i  ; 
double  fz(8]; 
double  xl[8]; 
double  fl[8]; 
double  x2[8]; 
double  f2[8]; 
double  x3[8]; 
double  f3[8]; 
double  tl,  t2,  t3  ; 


/♦current  time  •/ 

/♦initial  state  ♦/ 

/Julian  date  of  midnight  ♦/ 
/♦time  stq>  size  ♦/ 
/♦integral^  state  ♦/ 


/♦loop  counter  ♦/ 


Derivatives(m50,  P,  lERS,  jd_midnight,  tz,  xz,  fe)  ; 
tl  «  tz  +  0.4*step  ; 
for(i»l  ;  i<“7  ;  i++) 

{ 

xlli]  «  xzCi]  +  0.4^step^fzlil  ; 
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Oerivativei(iiiSO,  P,  lERS,  jd_iiiidiiight.  tl.  xl,  fl)  ; 
t2  “  tz  +  0.6'*Mq> ; 
for(i>Bl  ;  i< *7  ;  i++) 

{ 

x2[il  -  xz(i]  +  8tep-»(-0.15-^il  +  0.75*fl(il)  ; 

} 

Derivatives(iiiSO,  P,  lERS,  jd_iiiidiiight,  t2,  x2,  tl) ; 
t3  »  tz  +  8tq>  ; 
for(i=l  ;  i<ss7  ;  i++) 

{ 

x3[i]  *  xzti]  +  step*(19.0*fz[i]  -  15.0*flti]  + 
dO.O-^pD/dd.O  ; 

} 

Derivatives(tiiSO,  P,  lERS,  jd_inidiught,  t3,  x3,  f3) ; 
for(i=l  ;  i<=7  ;  i++) 

{ 

x[i]  =  xzli]  +  step*(55.0'''(fz[i]  +  f3[il)  + 
I25.0-»(fI[il  +  f2[i]))/360.0  ; 


} 
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iKfndef  RNP  M50  DATA  INCLUDED 
Idefiae  RNP_MSO~DATA_INCLUDED 


/* 


*  Data  for  tbe  Wooiard  Nutatioa  Mode! 

* 

*/ 


static  double  aQ  ^  { 

-17.2327  ,  -1.2729  .  0.2088  , 

-0.2037  ,  0.1261  ,  0.0675  .  -0.0497  . 
-0.0342  .  -0.0261  ,  0.0214  .  -0.0149  .  0.0124  . 

0.0114  .  0.0060  .  0.0058  ,  -0.0057  .  -0.0052  . 

0.0045  .  0.0045  .  -0.0044  .  -0.0032  .  0.0028  , 

0.0026  ,  -0.0026  .  0.0025  .  -0.0021  ,  0.0019  . 

0.0016  ,  -0.0015  .  -0.0015  .  0.0014  .  -0.0013  . 

0.0010  .  -0.0010  .  -0.0009  .  -0.0007  .  0.0007  , 

0.0006  .  -0.0006  .  -0.0006  .  -0.0006  .  0.0006  . 

-0.0005  .  -0.0005  ,  -0.0005  ,  -0.0005  ,  0.0005  , 

0.0004  .  -0.0004  .  -0.0004  .  -0.0004  ,  0.0004  , 

0.0004 , 4).0004  .  0.0003  .  -0.0003  .  -0.0003  , 
0.0003  .  -0.0003  ,  -0.0003  ,  -0.0002  ,  -0.0002  , 
•0.0002  ,  0.0002  .  -0.0002  ,  -0.0002  .  -0.0002  . 
0.0002  .  -0.0002  }; 

static  double  adotQ  «  { 

-0.01737  ,  -0.00013  ,  0.00002  .  -0.00002  , 
•0.00031  ,  0.00001  .  0.00012  .  -0.00004  , 


0.0  ,  -0.00005  ,  0.0 

,  0.00001  ,  0.0 

0.0  ,  0.0  ,  0.0 

,  0.0 

.  0.0  , 

0.0  ,  0.0  ,  0.0 

,  0.0 

.  0.0  . 

0.0  ,  0.0  ,  0.0 

,  0.0 

,  -0.00001 

0.00001  }; 

static  double  bQ  =  { 

9.2100  ,  0.5522  ,-0.0904  ,  0.0884, 
0.0216  ,  0.0183  ,  0.0113  ,  -0.0093  , 
-0.0066  ,  -0.0050  ,  -0.0031  ,  0.0030  ,  -0.0024  , 

0.0023  ,  0.0022  ,  0.0014  ,  -0.0011  ,  0.0011  , 

-0.0010  ,  0.0008  ,  0.0007  ,  -0.0007  ,  0.0007  , 

0.0005  ,  0.0005  ,  0.0003  ,  0.0003  ,  -0.0003  , 

0.0003  ,  0.0003  ,  0.0003  .  0.0003  ,  0.0003  , 

-0.0003  ,  0.0002  ,  0.0002  ,  -0.0002  ,  -0.0002  , 

-0.0002,  0.0002}; 

static  double  bdotQ  «  { 
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static  int 


static  int 


0.00091  ,  -0.00029  .  0.00004  .  -0.00005  , 
-0.00006  ,  0.0  ,  -0.00001  .  0.00003  }; 


caO  «  { 

0.0. 0.0. 1 .0.0. 0.2, 5, 2. 
0.0. 0.0, 0,2. 0,0. 0.2,0. 
2. 0.0. 1,0, 0.0. 0.1. 0.0. 0.0. 
0.0. 1  .2. 5. 2. 0.0. 0,2.0. 1 .0, 
1 ,0.2, 0,2, 0.0, 6. 2. 5. 2.0. 1  . 
0.0. 5. 0.0, 0.0. 2, 5, 1 ,0.6.0. 
2. 0.2. 0.0. 0.0. 2. 0.0. 1 .0.0. 
0. 1  ,0.6. 0,0.0, 1 .0,6, 0,2, 2, 
2. 0.5, 0,2.0, 1 .0.2. 0.0. 5.0 
0, 1 .0.2,0, 1 .0,0. 0.2. 2. 2,0 . 
2, 0.0. 0,0,0, 1 .0,2, 5. 2. 0.2. 
0,2, 0,2, 0,0, 0,2, 0.0, 0,0,0, 
2, 5, 0,0, 6, 0,2,0, 1  ,0,0, 2,0, 
0.0, 0.0. 2. 2. 5 .2,0,0. 1 .0.0. 
1 .0.6. 0.0, 2,  1 ,0, 1 ,0.0.5,  1  , 
0,2, 0.5. 0.0, 0.0. 6. 0.0. 1 ,0, 
6, 0, 2. 2.  1 .0, 1  ,  1  ,0.5. 0,0.0. 
1,2, 0,2, 0,1, 0.0, 2, 0,0, 0,0, 
0,2,1  ,0.0, 6, 2. 0,2.0, 1.0,2, 
2, 2, 0,2, 0.2, 5, 2. 0,5, 0.0, 2, 
1  .0.0, 6, 2, 5,  1 ,0,0, 0.0, 5.  1  , 
0.0. 0,2, 2. 1  ,0, 1 ,0,2.5.  1 ,0. 
2, 0,0, 5, 1 ,0,0, 5, 2, 5. 1 ,0,0, 
0,0, 1 .0,0.0, 1 ,0,5, 0,0, 1,6, 
0,0, 0,0, 1,0, 5, 0,0, 0.2, 0,2, 
0,1, 0,0,  1,2, 5, 1,0, 1,0, 0,6, 
0.0, 5, 0.2, 0,2,0, I ,0.2, 0,0, 
0, 1 , 1 ,0, 0,0,0. 1 ,6, 2,0, 2,0, 
1  ,6, 0,6, 0,0, 5, 0,0,0, 1 ,0,6. 
0,2,5,  1 ,0,2, 0,0,0, 1 ,0.6,6, 
2, 2, 2. 0.0, 6, 2, 2, 2,0, 1 .0,0. 
0,2,0, 1 . 1 ,2, 0.2, 0.3, 0,2,0, 
2,0}; 

cbD  =  { 

0,0, 0.0, 1 ,0,0, 0,2, 5, 2, 
0,0, 0,0, 0.2. 0,0, 0,2,0, 
2,0,0, 1 ,2, 5, 2, 0,0, 0,2,0, 1  . 
0. 1 ,0,2, 0,2, 0.0, 6, 2, 5. 2.0. 
0.0, 2, 5.  1 ,0,6, 0,2, 0,2,0, 1 , 
0,0, 0.1, 0,6, 0.0, 0,1, 0,5,0, 
2,0, 1 ,0. 1 .0,2,0, 1 ,0,6, 0,2, 
2, 2. 0.0, 0,2, 2, 2,0, 1 ,0,2,5, 
2. 0,2, 0,2, 0.2, 0,6, 0,2,0, 1  . 
0.0, 1 .0,0, 1 ,0.0, 2, 2, 5. 2,0, 
6. 0,0, 2,  1,0,1 ,0,0,5,  1 ,0,0, 
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6,0,0, 1 ,0,6, 0,2, 2, 1 ,0,5,0, 
0,2, 1 ,0,0, 6, 2, 5, I ,0,0, 1,2, 
0,2, 0,0, 0,0, 2, 1 ,0.0, 6, 2,0, 
2.0, 1 .0.2. 2. 2. 0,0, 0,0, 5,  1  , 
0.0, 0,2, 2, 1.0, 1,0, 2. 5, 1,0, 
0.5. 2. 5. 1,0, 5. 0.2. 0.2. 0.2, 
0,0,5, 1 .0.0. 1 .2.5, 1 .0.2,0. 
2, 5. 2. 0.2. 0,2.0, 1  .0}; 


static  iot  diiDaision[2K2]  »  { 

{  69  ,  ^  /*  dimeasioos  ca  &  cb  */ 

{  29  .  8  }  }:  t*  dimeasioos  adot  Sl  bdo:  *! 


static  int  modeJimits[2]  { 

69 , 40  };  Execution  limits  for 
opeiatioo  mode  set  to  1. 
Provides  the  appropriate 
number  of  data  points  from 
the  ca  &  cb  data  arrays  from 
the  nutation  1  mode  *! 

static  int  data_increment[2]  -  { 

4,4);  /♦  Provides  the  number  of 

coefficient  data  points  to 
be  used  in  the  calculation 
of  the  two  nutation  angle  *! 


/* 

* 

*  Coefficients  of  the  poiynonuals  for  mean  angles 

*/ 


Static  double  mean_angle_coef[7][4]  =  { 

/* 

*  Coefficients  for  the  mean  obliquity  of  the  celestial  equator 
'*  equivalent  to  epsilon  bar  (seco^  of  arc  ) 

*/ 

{  84428.26  .  -46.845  ,  -0.0059  .  0.00181  }  . 
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*  Set  tbe  mean  angle  index  such  that  the  free  Urbation  polynomial  goes 

*  unused. 

*/ 

static  int  MEAN_ANGLE_INDEX  »  {  6  }; 


/* 

*  Coefficients  of  precession  polyomials 

•/ 

static  double  precession  coetf]  «  { 

2304.M166S  ,  0.30216S  .  0.0180  . 
2004.258258  .  -0.426885  ,  -0.0418  . 
2304.951615  .  1.095195  .  0.01832  }; 

/* 

Set  the  parameters  that  relate  Greenwich  mean  siderial  time 

*  to  universal  time. 

*/ 

static  double  gmst_ut_relation_const  »  {  23925.836  }; 
sutic  double  gmst_ut_relation_dot  =  {  8640184.542  }; 
sbuic  double  gmst_ut_relation_ddot  =  {  0.0929  }; 


#endif  /*  Endif  for  RNP_M50_DATAJNCLUDED  */ 
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built  by  MUce  Fraietta  Jan  1993 
Program  modified  fy  Lee  Barker 


Function  declarations  contained  in  *util.h* 
date  mod  #  description 

23  Feb  93  1  addition  of  seconds_in_dayJd_time  functions 

24  Feb  93  2  addition  of  doy_utc_toJulian_date  function 

jKnclude  <math.b> 


#include  *uttl.h* 


#define  jdjan_6_1980_midnight  2444243.S  /'*<iPS  clock  start  */ 

/‘*julian  date  */ 


This  is  the  function  ’julian_date’ 
Input  arguments  are  - 
year  »- 
month  = 
day  = 

hours  - 

nmutes  — 
seconds  = 

Return  arguments  are  • 
jd(double)= 


ju^an  calender  year,  ie  1993 
month  number  (1''12) 
day  of  month  (1*31) 

hours  since  midnight  (military  time)  in  UTC 
ounutes  past  hour 
secotrds  past  minute 

Julian  date 


double  julian_date(year,montfa, day  .hours, minutes,seconds) 
int  year,month,day,hours,minutes  ; 
double  seconds  ; 

{ 

double  jd_noon,  jd  ; 
jd_noon=367.0*year  - 

floor(7.0‘''(year  +  floor((month+9)/12))/4.0)  + 
floor(275.0*month/9.0)  +  (double)day  +  1721014.0  ; 


jd  =  (double)id_noon  -  0.5  + 
hour8/24.0  + 
minutes/l 440.0  + 
seconds/86400.0  ; 
return  jd  ; 

} 
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This  is  the  function  'doy_utc_toJulian_date' 

Input  ai^guments  are  - 

doy  =  day  of  year  (1-365) 
hours  s  hours  since  midnight  (military  time)  b  UTC 
mbutes  =  mbutes  past  hour 
seconds  =  seconds  past  mbute 
Return  arguments  are  - 

julian_date(double)s;  Julian  date 

Year  is  assumed  to  be  1993.  For  different  year,  change  year  b  call 
to  ’julian_date’. 

#ifdef  GIGO 

double  doy_utc_tojulian_date(doy,hour,mb,sec) 
double  ^  : 
b'  i-  y.hour.mb; 

{ 

double  seconds_sbce_midnight; 
double  julian_date_of_year; 
double  jd; 

secoads_sbce_midnight  =  3600.0'*'hour  +  60.0*min  +  sec; 

Julian_date_of_year  =  julian_date(1993,  1,  1,  0,  0,  0.0); 

jd  =  julian_date_of_year  + 

doy  +  seconds_sbce_midm^t/86400.0; 


returned); 

} 

#endif  GIGO 


This  is  the  function  ’nuignitude' 

Input  arguments  are  - 

a  —  4x1  vector  where  the  zero  element  is  not  used 
and  a  3x1  vector  is  held  b  the  reqrective  elements 
Return  arguments  are  - 

(double)  the  magnitude  of  the  vector  ’a' 


double  magnitude(a) 
double  a[4]  ; 

{ 

double  mag; 

mag-8qrt(a[l]-^l] +a[21M2] +a(3]*a[3]); 
return  (mag); 

} 
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This  is  the  function  ’dot’ 

Input  arguments  are  - 

a  s  4x1  vector  where  the  zero  element  is  not  used 
and  a  3x1  vector  is  held  in  the  req>ective  elements 
b  ss  4x1  vector  where  the  zero  element  is  not  used 
and  a  3x1  vector  is  held  in  the  respective  elements 
Return  arguments  are  • 

(double)  the  dot  product  of  ’a’  and  ’b’ 

double  dot(a,b) 
double  aQ,bQ  ; 

{ 

return  (a[l]*b[l]+a[2]*b[21+aI3]*b[3])  ; 

} 

/4f:t‘>k‘*********<lf***‘***************************'IKIf******‘t‘************t‘*******‘t‘'>f* 

This  is  the  fimction  ’cross’ 

Input  arguments  are  - 

a  s  4x1  vector  where  the  zero  element  is  not  used 
and  a  3x1  vector  is  held  in  the  respective  elements 
b  -  4x1  vector  where  the  zero  element  is  not  used 
and  a  3x1  vector  is  held  in  the  respective  elements 
Return  arguments  are  • 

c  —  4x1  vector  where  the  zero  elements  are  not  used 
and  a  3x1  vector  of  the  cross  product  is  held  in 
the  respective  eleoMnts 

void  cross(a,b,c) 
double  aQ,bD,cQ  ; 

{ 

cll]  =  al21*b[3]  -  al31*b[2]  ; 
c[2]  =  at3]*b(ll  -  atll*b[3]  ; 
c[3]  =  a[l]*b[2]  -  a(2]*b[ll  ; 

} 

This  is  the  function  ’unit’ 

Input  arguments  are  - 

a  =  4x1  vector  where  the  zero  element  is  not  used  and 
a  3x1  vector  is  held  in  the  respective  elements 
Return  aigumento  are  • 

a  ss  4x1  vector  where  the  zero  element  is  not  used  and 

the  normalized  3x3  matrix  is  held  in  the  req>ective  elements 

4n|n|i*4u»4u»i)i4i*itie4i4i4i4nti4>4>4i4<4i*«e4n|i4ii|i4i*4ie*4i*4ie*4>4iee4«ti4i4i*4ie4i4i4i4>4i4i***«>4"**4i>*4i4i4i*4>*4i4i<*/ 

void  unit(a,b) 
double  aQ,bQ  ; 

{ 

double  a_mag_i  ; 
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«_iiuig_i  s  1.0/sqit(dot(a,a))  ; 
b[l]  a  a(ll''»_mag_i  ; 
b[2]  a  a[2]''^_iiiag_i  ; 
b[3]  a  a[3]'*a_iiiag  i  ; 

} 

This  is  the  function  iactoriaI_ratio 
Input  arguments  are  - 
n.k  a  integers 
Return  arguments  are  • 

ans(double)  a  the  factorial  ratio  of  n  to  k 

double  Aictorial_ratio(n,k) 
int  n.k; 

{ 

double  ans; 

int  i.stop.start; 

if(n  a=  k)  retum(l.O); 
if  (n  >  k) 

{ 

start  a  k+1; 
stop  a  n; 

} 

else 

{ 

start  a  n+1; 
stop  a  k; 

} 

ans  a  (double)start; 

for(i  a  start+1;  i  <a  stop;  i++)  ans  a  ans''^double)i; 
if(k  >  n)  ans  a  1 .0/ans; 

retuni(ans); 

} 

This  is  the  function  ’sqr’ 

Input  arguments  are  - 
a  a  (double) 

Return  arguments  are  • 

(double)  the  square  of  ’a’ 

■|ii|i4i4>4"Mii»4i4i4>4i4i4i***4i4i<ti4i4i4i4i4<it>*4>4ii|i4i4i<ti4i4i4uk4i4i4i*4i4i<Mi4uti4i4>4i4i4i4i4>i^4i4ii*4i4i4i**<*4i4i4i4i4>4'Hi4i*<K4>/ 

double  sqr(a) 
double  a  ; 

{ 

return  a"^  ; 

} 
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This  is  the  function  ’fnc’ 

Input  arguments  are  - 
X  s  (double) 

Return  arguments  are  • 

(double)  the  fractional  part  of  ’x’ 

double  firac(x) 
double  X  ; 

{ 

double  floorO  ; 
retum(x-(double)floor(x))  ; 

} 

This  is  the  function  ‘*jdtocd 

void  jdtocd(jd,montho,dayo,yearo,houro,minuteo,secondo) 

double  jd  ; 
double  '''secondo  ; 

int  ''teontho,''^yo,'*yearo,'''houro,'*'ininuteo  ; 

{ 

double  fkx>rO>ceilO>fncO  ! 

double  jdten4>,f,alpha,z,a,b,c,d,e  ; 

double  day,montb,year,hour,minute,second  ; 

jdtemp»jd+0.5  ; 
f=frac(jdtemp)  ; 
z— jdten^>-f  ; 


if(z  <  2299161.0) 

{ 

a=z  ; 

} 

else 

{ 

alpha»(double)floot((z-1867216.2S)/36S24.25)  ; 
a=z+1.0+alpha*(double)floor(alpha/4.0)  ; 

} 

b=a+ 1524.0  ; 

c»(double)fIoot((b-122.1)/365.2S)  ; 
d=365.25*c-ftac(365.25'^;)  ; 
es(double)floor((b-d)/30.6001)  ; 

day=b-d-(30.6001-^frac(30.6001*e))+f  ; 
'"dayoasflooifday)  ; 
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if  (e  <  13.S)  monthse-l.O  ;  else  iiioath*e-13.0  ; 
if  (month  >  2.5)  year*c-4716.0  ;  else  ye«r“c-47l5.0  ; 

*moodioBfloor(month)  ; 

''y«uro*floor(ye*r)  ; 

hours  hrac(day)*24.0  ; 

minutes  firac(hour)'*60.0  ;  second sfinc(minute)'*60.0  ; 

'*1)ouros(iiit)floor(hour) ; 

'''minuteos(iiit)/]oor(mioute)  ; 

"■secondossecond  ; 

if  ("'secondo  >  =  60.0) 

{ 

'*secondos0.0  ;  ^minuteo  s  ^minuteo+l  ; 

} 

if  ("Wnuteo  >  s  60) 

{ 

'*teinuteosO  ;  "liouro  s  <410010+1  ; 

} 

} 

This  is  the  function  OMtrix_x_niatrix 
Input  arguments  are  • 

a  s  4x4  matrix  where  the  zero  elements  are  not  used 
and  a  3x3  matrix  is  held  in  the  respective  elements 
b  s  4x4  matrix  where  the  zero  elements  are  not  used 
and  a  3x3  matrix  is  held  in  the  respective  elements 
Return  arguments  are  • 

c  s  4x4  matrix  where  the  zero  elements  are  not  used  and 
the  product  3x3  matrix  is  held  in  the  respective  elements 

^0^i^^m4iit‘**********m****'t"i‘’i"i‘0*****’i"i‘**’i‘*0***’***t‘4i*'>‘**’t"t‘***'*******************/ 

void  matrix  x_matrix(a,b,c) 
double  al4](4]Tb[4][4].c(4K4]  ; 

{ 

int  i,j,k ; 

for(isi  ;  i<s3  ;  i++) 

for(k=l  ;  k<s3  ;  k++) 

{ 

c[i][k]s0.0  ; 

forijsl  ;  j<s3  ;  j++)  c[i][k]sc[i][k]  +  a[i3[j]*b[j][k]  ; 

} 

} 

This  is  the  function  niatrix_x_vector 
Input  arguments  are  - 

a  s  4x4  nnatrix  where  the  zero  elements  are  not  used 
and  a  3x3  matrix  is  held  m  the  respective  elements 
V  «  anay  containing  a  3x1  vector  where  the  zero  element 
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is  not  used 

Return  arguments  are  - 

v_out  »  array  containing  a  3x1  vector  product  of  *a’ 
and  ’v’  where  die  zero  element  is  ncrt  used 

void  inatrix_x_voctor(a,v,v_out) 

double  ■(4][4],vi4],v  out[4]  ; 

{ 

int  ij  ; 


for(is]  ;  i<=3  ;  i++) 

{ 

v_outli]=e0.0  ; 

for(j=l  ;  j<=3  ;  j++)  V  out[i]  =  v  outti]  +  alil[j]*vGl‘. 

} 

} 

This  is  the  function  matrixTraaspose_x_vector 
Input  arguments  are  - 

a  =  4x4  matrix  where  the  zero  elements  are  not  used 
and  a  3x3  matrix  is  held  in  the  respective  elements 
V  =  array  containing  a  3x1  vector  where  the  zero  element 
is  not  used 

Return  arguments  are  • 

v_out  =  array  containmg  a  3x1  vector  product  of  'a’transpose 
and  *v'  where  the  zero  element  is  not  used 

**ti^ih*mm**m*******<¥*******r¥**************0***'ki***m*mm*******m*m4t***********/ 

void  matrixTranspose_x_vector(a,v,v_out) 

double  a[4][4],v[4],v  out[4]  ; 

{ 

int  iJ  ; 


for(i=l  ;  i<=3  ;  i++) 

{ 

v_out[i]*0.0  ; 

for(j=l  ;  j<=3  ;  j++)  V  out[i]  =  v  outti]  +  aO][il*v|j]  ; 

} 

} 

/i«i«4'4iiMi4i4i4iiti4i4utiik*4i*4i4i*i|i4i4i4i4>4>4i4i4i*4i*4i4r4i4>4i4i4i4i*4>e4i***4i*4ii*4i4>4i*4i4i*4i*i»4i4u)i*iMi**4i4i4>4i4ii»/ 

This  is  the  function  jd_time 
Input  arguments  are  - 

gps_week_number  »  GPS  wedc  number  starting  at  week  0  on  6  Jan  1980 
gps_seconds_in_wedc  »  seconds  starting  Sunday  morning  UTC 
Return  arguments  are  • 

(jd)  V  Julian  date 

double  jd_tiffle(  gps_week_number,  gps_seconds_in_week} 
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double  gps  week  number, spe  seconds  in  week; 

{ 

double  jd; 

jd  «  jdjan_6_1980_midnight  +  7'*‘gps_wedt_nund)er  + 
gps_secoods_in_week/86400; 

return  (jd); 

} 


This  is  the  function  '8ecoods_in_day' 

Input  arguments  sie  - 

gps_seconds_in_week  «  seconds  starting  Sunday  morning  UTC 
Return  arguments  are  - 

(sec<»ds)  K  seconds  in  day  since  midnight 

*^itfm>li0f^<tt**^im*******0*0****'l‘**'l“¥********‘¥***^‘*******4i*it‘***m*****'¥*^t****m*’¥'lf*/ 

double  8econds_in_day(gp8_aeconds_in_week) 
double  k.r**  seconds  in  week; 

{ 

double  seconds; 

seconds  *  fmod(gps_seconds_in_week,86400); 
return  (seconds): 

} 

f4i^itiHLm****<iniutLii^m<tt4imiti0mm*i^***0^nititi***4‘m********mmmm**m*************************/ 
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/■* 


fifiidef  UTIL  INCLUDED 

#defuie  UTIL  INCLUDED 

*/ 

void 

jdtocdO ; 

double 

julMui_dateO  ; 

double 

dolQ  : 

double 

*qrO  ; 

double 

frecO  ; 

double 

mi^tudeO  ; 

double 

ftctorMi_ntioO  ; 

double 

jdjimeO; 

double 

secoDds_iii_dayO; 

double 

doy_utc_loJuli«n_date(); 

void 

niatrixTnuuipose_x_vectorO; 

void 

iiHdrix_x_vectoiO; 

void 

nMtrix_x_nHUrixO: 

void 

unitO; 

void 

croasQ; 

void 

rotetion _generatorO: 

void 

nutatim _geiientor  Q; 

void 

pieceadoD _geiieratorO: 

void 

nip.mSO  0; 

void 

uistantiate_gotpotO; 

void 

geai_9_iiiodel_dal*0; 

void 

get _gimvity_d«taO; 

void 

get_iotation_angiesO; 

void 

goqfKMO; 

void 

DerivativesO: 

void 

get_iiiertial_to_wg884_iiiatrix0; 

void 

coiiipute_a_iiiatrixO; 

void 

Runge_Kutta_40; 

void 

cowellQ; 

void 

bgpiopO; 

/• 

Utendif 

•/ 

util.h 
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fincliMie  <stdio.h> 
jKaclude  <stdlib.b> 
finclude  <coiuo.b> 
#include  <ttring.b> 
inoclude  <cQrpe.b> 

#iiiclude  <edit.b> 
finclude  <k^s.b> 


■*! 


* - •/ 

#define  YES  1 
#define  NO  0 

eoum  edit_type8  {  EDIT_«lpba,  EDIT_numb,  EDIT_text  }; 

#define  WORKSITE  80 

static  cbar  work[WORKSIZE+ 1]; 


♦ - *! 

static  int  edit(cbar  ''‘label,  eaum  edit  type  type) 

{ 

cbar  "liext  =  work  -f  strieii(work); 
printf(''%s%s'',  label,  work); 

for  (;;) 

{ 

int  k^  =  key _getO; 


if  (k^  =  =  KEY  esc)  return  NO; 
if  (key  ==  KEY“ cr) 

{ 

putcb(k^);  putcb(KEYJf); 
return  YES; 

} 

if  (key  *=  KEY  bs) 

{ 

if  (next  s  s  work)  continue; 
♦(-next)  «  0; 

putcb(’\b’);  putcbC  ’);  putcb(’\b’); 
continue; 

} 
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if  (!  inicii(k^))  cootiDue: 

fwi^  (0^) 

{ 

case  ElMT_alpha: 

if  (!isaiplia(k^))  coatuHie; 
bfeak; 

case  EDIT_nuiiib: 

if  (!i^git(key)  ASi  key  !«  AA  key  !»  oondBue; 

br^: 

case  EI>rr_text: 

if  (!isgraph<key))  continue; 

br^; 

} 

*next++  =  key; 
putch(key); 

} 

} 


* - */ 

char  *edit  text(char  *label,  char  ^initial) 

{ 

int  size  =  strlen(initial); 

if  (size  >  WORKSIZE)  initial[WORKSIZE]  «  0; 
strc}iy(work,  initial); 

if  (edit(Iabd,  EDn'_text)  s  s  NO  1 1  work[0]  ^  «e  0)  strcpy(work,  initial); 
return  work; 

} 


/** 


* - */ 

int  edit  intesa<char  *labe),  int  initial) 

{ 

sprintf(woTk,  *%d*,  initial); 

return  (edit(label,  EDIT  numb)  =  —  NO  j  |  work[0]  =  =  0  ?  initial  :  atoi(work)); 

} 


* - ♦/ 

long  edit  integer  Iong(char  *Iabel,  long  initial) 

{ 

sprintfCwork,  ”%ld”,  initial); 
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ntURi  (edit(label.  E[OT_ouiidi)  »  «  NO  |  j  woric{0}  «  s  0  ?  initial  :  atol(w(»k)); 
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/■*» 


#iiiclude  <stdUb.h> 
#iiiclude  <8tdio.h> 
ittaclude  <cooio.b> 

#iiiclude  <edU_rt.h> 
fiiicliide  <keys.h> 
iKnclude  <tiiiies.b> 

/*m  ssssssssa 


■V 


* - */ 

ini  edit  field inUchar  '^vofk,  void  "'daU) 

{ 

sprintf(woric,  "^d*.  ♦(int  '*')data); 
return  -1; 

} 

int  edit  field_put  int(char  '*Mvork,  void  "'data) 

{ 

"■(int  "')data  =  atoi(work); 
return  YES; 


int  edit  field  key  int(Edit  field  info  '^fo,  int  key) 

if  ((key  >=  ’0’  &&  key  <=  ’9’)  1 1  key  ==  ’-’) 

{ 

edit_field_insert(info,  key); 
return  YES; 

} 

return  edit_field_key_bandier(info,  key); 


* - */ 

int  edit  field_get_dbl(char  "Mrork,  void  'Mata) 

{ 

sprintf(work,  "ft.nig”,  "^double  "')data); 
return  -1; 


int  edit  field_put  dbl(char  "Mvork,  void  "data) 

{ 

'^(double  "')data  =  atof(work); 
return  Y^; 


•dlt  fld.c 


•dlt  fld.c 


int  edit_field  key  dUOBdit  field_iiifo  ^info,  int  key) 

{ 

if  ((key  >=  ’O’  &A  kqr  <=  ’9’) 

II  key»»’-’  II  key  ||  key ’e’  ||  key  »=  ’E’ 

{ 

edit_field_tnsert(info,  key); 
ledirn  Y^; 

} 

return  edit_fieId_key_lHuidIer(info,  k^); 


* - */ 

int  edit  field jget_yesno(char  *^vork,  void  '*'deta) 

{ 

work[01  *=  C^int  *)data  ?  ’Y’  :  ’N’); 
work[l]  =  0; 
return  0; 

} 

int  edit  fieid_put_yesno(char  *wofk,  void  'Mata) 

{ 

■*(int  *)dau  =  (work[0]  ==  ’Y’  ?  YES  :  NO); 
return  YES; 

) 

int  edit  field  key_yesno(Edit  field  bfo  'M>fo,  int  key) 

int  X,  y; 

switch  (k<^) 

{ 

case  ’Y’:  case  ’y’:  case  ’N’:  case  ’n’: 
if  (key  >  ’a’)  key  -=  ’a’-’A’; 
if  (info~>work[0]  !»  key)  info->changed  =  YES; 

X  =  wherexQ  •  info->cursor_off8et;  y  =  whneyO; 
info->cur8or_ofrset  =  0; 

gotoxy(x,  y);  putch(info->woik[0]  =  key);  gotoxy(x,  y); 
return  YES; 

case  KEY_esc:  return  (info- >  changed  ?  2  :  0); 
default:  return  NO; 

} 

} 


/•»s  s  s  =  s  s  s : 


■*/ 
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int  edit  fieid_fet  diunsUcher  ^oric,  void  ^deu) 

{ 

double  temp  »  ^^double  '*)deU  'f  86400.0; 
return  edit_field _get_dhouO(woric,  dUemp); 


int  edit  fleld_put_dhmsl(char  '*^vork,  void  *daU) 

{ 

edit_field_put_dliins0(work,  data); 

if  ((^(double  *)data  86400.0)  <  0.0)  *(doubie  *)data  =  0.0; 
return  YTS; 


int  edit  field  get_dhin90(char  'Nvork,  void  '''data) 

{ 

tiine_dbl_to_string((double  *)data,  work); 
return  0; 


int  edit  f!eid_put  dhmsOfchar  'Nvork,  void  'Mata) 

{ 

Tioie_dhins  dfams; 

work[3]  =  work[6]  *  workt9]  =  worktl2]  =  0; 

dhms.days  s  atoi(woik); 

dhms.hours  ^  atoi(woik+4); 

dhins.inins  =  atoi(work+7); 

dhms.secs  =  atoi(wotk+ 10); 

dhms.msecs  =  atoi(work+]3); 

time_dluns_to_dbl(&dhins,  (double  ''')data); 
return  YES; 


int  edit  field  key  dliins(Edit_Eeld  info  "^nfo,  int  key) 

char  ''\vhere; 
mt  rc,  key_max; 


if  (key  >=  ’0’  du&  key  <»  ’9’) 

{ 

where  =  info->work  +  iiifo->cursor_ofFset; 
if  (info->cursor_offset  ===4) 

else  if  (info->cursor_off8et  ss  7  ||  info->cursor_offset 
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key_niax  ®  ’2’; 
=  «  10)  keyjmax  *  ’5’; 
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key_inax  =  ’3’; 
key_inax  =  ’9’; 


else  if  (mfo->cursor_ofltet  »*=  5  &&.  where[-13  ==  ’2’) 
else 

if  (key  >  key_inax)  return  YES; 

if  (*where  !=  key)  info- >  changed  =  YES; 
putcbCSvbere  =  key); 

if  (info->cursor_offset  ——A  StSt  where[l]  >  *3’) 

{ 

info->cursor_offset++;  wheie++; 
putchC'^vhere  =  ’3’); 

} 

if  (info- >  cursor_ofl5et  <  15) 

{ 

info-  >  cursor_ofFset+  + ;  where+  + ; 

if  (*where  ==  ’/’  |  |  *where  1 1  *where  ==  ’.’) 

edit_field_key_handier(info,  KEY_right); 

} 

else  gotoxy(wherexO  -  1,  whereyO); 
return  YTS; 


/* - 

♦/ 

switch  (key) 

^  /* 

I  can't  allow  backspace/delete,  they  have  no  meaning  for  the  fixed 
position  time  string. 

*/ 

case  KEY_bs: 

case  KEY_del:  return  YES; 

/* - 

I  don’t  want  the  default  key  handler  mcving  the  cursor  beyond  the 
end  of  the  time  string. 

*/ 

case  KEY_end: 

gotoxy(wherexO  +  info- > size  -  info->cursor_offset  -  I,  whereyO): 
info->cursor_offset  =  info- >  size  -  1; 
return  YES; 

case  KEY_right: 

if  (info->cursor_offset  ==  15)  return  YES; 

} 


/* - 

I  have  to  add  an  extra  left/right  keystroke  when  the  cursor  lands  on  a 
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*  sqwntor  chancter  (/:). 

*! 

if  ((re  =  edit_field  key  handleifinfo,  key))  =  =  1) 

{ 

where  s  iiifo->woric  +  info->ciiraor_offaet; 
if  ("Where  =»b  ’/’  1 1  "Where  1 1  "Where  ==  ’ 

edit  field  key  handleifinfo,  key); 

} 

return  re; 
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* _ 

iKnclude  <sUiUb.h> 

#include  <stdio.h> 

#include  <conio.b> 

#include  <8tring.h> 

#include  <edit_rt.h> 

^include  <keys.b> 

iK _ 

Static  cbar  woiic[80]; 

static  Edit_screen  ’*^rev_screen; 


•*/ 


•*/ 


I  force  the  field  to  regeoerate  its  string,  tbea  1  draw  tbe  string  and 
position  tbe  cursor. 

>*■ _ */ 

static  void  field  reset(Edit  field  info  "info,  Edit  field  *field,  int  preclear) 

{ 

int  first_offset; 

if  (preclear  &&  info- >  size) 

{ 

memsetfwork,  ’  info- >  size); 

gotoxy(field- >  col,  field- >  row); 
cputs(work); 

} 

first  offset  =  (""field- >get)(work,  field- >  data); 
gotoxy(field->col,  field- >  row); 
cputs(work); 

info- >  size  =  strien(woric); 

if  (first_offset  <  0  j  |  (info->cursor_offset  =  first_offset)  >  info- >  size) 
info->cursor_offset  *=  info- >  size; 
gotoxy(field->col  +  info->cursor_offset,  field- >  row); 

info- >  changed  ^  NO; 

} 


/♦=  3S  S  S  S  S  S  B  I 


4>. 


•"■/ 
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void  edit_screen_iiiit(Edit  screen  ^screen) 

{ 

int  count; 

Edit_label  *label; 

Edit_field  *field; 

f* - 

*  Clean  up  the  previous  screen,  if  it’s  still  iq>. 

*/ 

if  (prev_screen  !=  NULL  &&  prev_screeo->post  !=  NULL) 
(*prev_screen-  >  post)(prev_screai); 


/*. - 

Show  all  labels  and  fields. 

*/ 

clrscrO; 

prev_screen  =»  screen; 
screen*  >  changed  s  MO; 

if  (screen- >pre  !=  NULL)  (*screen->pre)(screen); 

for  (label  =  screen- > labels,  count  =  screen->label  count;  count  >  0;  label+  +  ,  count--) 

{ 

gotoxy(label->col,  label- >  row); 
cputs(label-  >  string); 

} 

for  (field  »  screen- > fields,  count  «  screen- >  field  count;  count  >  0;  field+-»‘,  count-) 

{ 

(♦field- >getXwoik,  field- >  data); 
gotoxy(field->col,  field- >  row); 
cputs(work); 

} 


/* - - 

♦  Convert  first  field  to  text,  save  its  size. 

♦/ 

screen- >cuiTent_field.iofo. work  ^  work; 

fidd_reset(&screen->curmit_field.info,  screen- >curra)t_field.ptr  =  screen- >  fields,  NO); 


♦  I’m  called  by  some  piece  of  code  that  wants  to  take  over  the  screen. 

void  edit  screen  stopO 

{ 


Edit_screen  ♦screen  =  prev_screen; 

if  (screen  =  =  NULL)  return; 
prev_screen  *  NULL; 


edit  rt.c 


•dlt  rt.e 


if  (screen- >  current  field.info.changed) 

{ 

Edit_field  *field  »  screen- >cuneat_field.ptr; 

if  ((*field->putXwork,  field- >  date)  «=  NO) 

field_reset(&scfeeo->current_field.info,  field,  YES); 
else  screen- >  changed  b  YES; 

} 

if  (screen- >  post  !«  NULL)  ("'screen- >post)(screen); 


My  return  values  are: 

0  1  didn't  use  the  key 

1  1  used  the  key 

2  I’m  done 

int  edit  screen  key_handler(Edit  screen  '"screen,  int  key) 

{  ■  ' 

Edit_field  "‘field  =  screen- >current_field.ptr; 

Edit_field  "‘last_field; 
int  rc; 

I* - 

"'  Gdl  the  Eeld’s  key  handler,  check  its  return  value  for: 

"'  0  It  didn’t  use  the  key,  1  will  check  the  key  myself 

"'  1  It  used  the  key,  1  can  return 

"'  2  1  must  reset  the  field  to  original  condition 

*! 

rc  =  ("'field- >keyK&screen->current_fietd.  info,  key); 

if  (rc  >  0) 

{ 

if  (rc  —  =  2)  iield_reset(&screen->current_fieid.info,  field,  YES); 
return  1; 

} 


/♦ - 

"'  The  field  didn’t  use  the  key.  I’ll  check  the  k^. 

"■/ 

last_field  =  screen- >  fields  (screen- >field_count  -  1); 

switch  (key) 

{ 

case  KEY_esc:  rc  —  2;  break; 

case  KEY  up: 
case  KEYlbacktab: 

if  (— screra->current_field.ptr  <  screen- >  fields) 
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screen- >cumot_fieId.ptr  »  lsst_field; 
rc  ss  1; 
break; 

case  KEY  down: 
case  KEYltab: 
case  KEY_cr: 

if  (+ +screen->cuiTeDt_lield.ptr  >  last_fieid) 
screen- >cuiTent  field.ptr  ^  screen- >  fields; 
rc  =  1; 
break; 

default:  return  0; 


I* - 

*  Check  if  the  field  was  changed.  1  only  teach  this  code  after  I’ve 

*  picked  a  new  field,  or  I'm  done  with  this  screen. 

Then  move  to  and  resfaow  the  new  current  field. 

*1 

if  (screen- >cunent_field.info.changed) 

{ 

if  (("field- >putKwoik.  field- >  data)  ==  NO) 

field_reset(&screen->currait_field.info,  field,  YES); 
else  screen- >  changed  s  YES; 

} 

if  (re  =  =  2) 

{ 

if  (screen- >  post  !=  NULL)  (*screen->postXscreen); 
prev_screen  =  NULL; 

} 

else  if  (rc  =  =  1) 

field_reset(&screen->current_field.info,  screen- >current_field.ptr,  NO); 
return  rc; 

} 


0  Didn’t  use  the  k^ 

1  Used  the  key 

2  Used  the  key  (reset  my  field) 

* - */ 

int  edit  field  k^  haiKiler(Edit  field  info  *info,  int  k^) 

int  X  »  wherexO,  y  *  wher^O; 
chruT  "Nvhere; 

/* - 
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*/ 

switch  (key) 

{ 

/* — - 

*  If  this  field  was  dianfod,  then  I’U  use  the  and  request  the 

*  field  be  restored  to  its  original  value.  Otherwise  1  don’t  use  the 

*  k^,  ni  let  some  upper  k^-handler  use  the  k^. 

*/ 

case  KEY_esc:  return  (info- >  changed  ?  2  :  0); 

/* - 

*  Movement  k^s  only  affect  the  cursor  locatioo. 

*1 

case  KEY_Ieft: 

if  (— info->cursor_ofhet  <  0) 
info-  >  cursor_offset+  + ; 
else  X—; 
break; 

case  KEY_right: 

if  (+-^info->cu^sor_offset  >  info->size) 
info-  >  cursor^offset— ; 
else  X++; 
break; 

case  KEY_home: 

X  -»=  info->cursor_offiKt; 
info->cursor  offset  =  0; 
break; 

case  KEY_end: 

X  +SS  info->8i2e  -  info->cursor_ofhet; 
info->cursor_offset  =  info- >  size; 
break; 


/* - 

*  Deletion  keys  affect  content,  and  sometimes  cursor  location.  The 
backspace  is  turned  into  an  equivalent  delete. 

*! 

case  KEY.bs; 

if  (info->cursor_offset  **  0)  break; 
info->cursor_ofbet— ;  x— ; 
goto^(x,  y); 

case  KEY_dei: 

if  (info- > size  0  ||  info- > cursorjoffwt  >  ^  info- > size)  break; 
where  *  info->worfc  +  info->cursor_offoet; 
fflmnmove(where,  where+1,  info->size  -  (where  -  info->work)); 
cputs(where);  putch(’  ’); 
info->size~;  info->changed  »  YES; 


edit  rt.c 


•dlt  rt.c 


bfMk; 

de&iilt:  raturn  NO; 

} 


/* - 

*/ 

fotoxy(x,  y); 
retuni  YES; 


_ T _ T _ r _ ..TT _ 

void  edit  field  iiisert(Edit  field  info  ^fo,  int  key) 

{  “  ■ 

char  *wliere  =  iiifo->work  +  mfo->cur8or_offiKt; 

/* - 

*f 

if  (mfo->cur8or  ofiaet  <  info->8ize) 

{ 

int  X  *  wherexO.  y  “  whereyO; 
memmovefwhere-M,  where,  iafo->size  •  (where  •  uifo->work)  +  I); 
cputs(where); 
gotoxy(x,  y); 


/* - 

*/ 

putch(^heie  =  key); 

info- >  size+ + ;  info->curaor_offeet+-f;  info- >  changed  =  YTS; 
info- >work[info->  size]  =  0; 


•dlt  rt.c 


MB  Jtons.c 


*  Public  Domain 

*  ThcMnas  J.  Silva  and  The  Telemetiy  Woriudnp,  Inc. 

*  - */ 


finclude  <dos.h> 
ifinclude  <mem.b> 


jKnclude  <mun.h> 


• - */ 

void  enun_info_constnict(Enun  info  *thia) 

{ 

static  char  enun_nanieQ  »  'EMMXXXXO*; 

ul^  far*eaun_dev; 
char  '*1ianie; 

ushort  version,  lTan)e_se£,  count; 

/• - 

*  Make  sure  phys-pages  is  zero  (b  case  I  return  for  error).  Then  get 

*  the  btemipt  vector  for  the  EMM  device  driver. 

*  The  device  driver  has  its  name  at  offset  OxOa,  so  use  the  segment  of 

*  the  btemipt  vector,  but  force  the  offset.  Qieck  the  8  byte  name. 

♦/ 

memsetfthis,  0,  sizeof(Enim_bfo)); 

eimn_dev  =  MK_FP(FP_SEG(getvect(EMM_INT)),OxOa); 

for  (name  -  emm_naine',  *name  &&  "name  -=  *emm_dev;  naine+  +  ,  emm_dev-f+); 
if  (^‘name  ! »  0)  return; 

/* - 

*  Now  I  know  that  the  EMM  driver  exists,  so  go  get  its  version  number. 

*/ 

if  ((this->iast_error  =  _emm_version(&version))  !—  0)  return; 
if  (version  !  =  EMM_VER4)  return; 

/* - 

'*  Get  the  total  number  of  logical  pages,  and  the  free  page  count.  Then 
^  get  the  page-frame  segment  and  All  b  the  page  segment  array. 

*1 

if  ((this->last_aTor  ^  _emm_pages(&this->pages_tota],  &this'>pages_free))  !s  0)  return; 

if  ((this->last_mTor  «  _enim_fnme_seg(&frame_seg))  !=  0)  return; 

this->phys.pages  «  4; 

for  (count  =  0;  count  <  4;  count++) 


cons.c 


coas.e 


{ 

Uiis->|riiys.segiiieDts[count]  *  fnune_ieg  +  (count  *  EMM_PAGE_PARAS); 
this- >  map  0123[count].page  «  this- >  map  0l23[couat].phys  »  count; 

} 


/■•■SSSSSKKI 


* - */ 

void  emm  construct  iiew(Emffl  handle  *this.  Vmm  iofo  *info.  ushort  pages) 

{  ■  "  ■ 
this->info  »  info; 

/* — OLD  this->pages_mapped  »  0;  — */ 
this- >  pages  =  pages; 


if  ((info->last_eiTor  s  _eiiim_a])oc(&this->  handle,  pages))  !=  0)  this- >  handle  ^  0; 
_emmjxiges(&info->pages_totaI,  &info->pages_free); 


void  emm  construct  known(Emm  handle  ‘‘this,  Emm  info  '*4nfo,  ushort  handle) 

{  ■  ■  ■ 
this- >  info  s  iofo; 

/* — OLD  this->pages_mapped  =  0;  — *! 
this->handle  »  handle; 

if  ((info- >  last  error  —  emm  handle_pages(handle,  &this->  pages))  !«  0)  this- >  handle  =  0 

} 


* - */ 

void  emm_destroy(Emm  handle  "Ihis) 

{ 

/* — OLD  Emm_mapped  *^p,  '*niap_end;  — *! 

if  (this- >  handle  ~  —  0)  return; 

this- >  info- >last_error  —  _emm_free(this->  handle); 

this->handle  ^  0; 

this- > info- >pages_free  -l-s  this->pages; 

/*—  OLD  — 

if  (this->page8_mapped  »»  0)  return; 

for  (map  —  this- > info- >ma{q)ed,  map_eod  ^  mi^  -f  4;  ni»p  <  m^>_end;  nu^>+-l-) 
if(map->emm  =*  this)  iiu^->emm  =  NULL; 

—  OLD  —*/ 

) 


cons .  c 


Iowa. an 


*  Public  Donain 

*  Thomu  J.  Silva  and  The  Telemetiy  Workshop,  Inc. 

* 


ideal 

model  large,C 


codeseg 


int  _emm_version(ushoit  ^version) 
returns  EMM  return  code 


proc  _enun_version 

arg  arg_VERS:ptr  word 


endp 


mov 

int 

xor 

xchg 

les 

mov 

mov 

ret 


ah,46h 
67h 
cx,cx 
cl, ah 

»>x,[arg_VERS] 

[es:bx],ax 

ax,cx 


;Get  version,  al  =  version,  ah  s  rc 
;cx  =  return  code 
;ax  as  version 


int  _emm_pages(ushort  *total,  ushort  '*'firee) 
returns  EMM  return  code 


proc  _emm_pages 

arg  arg_TOTAL:ptr  word,  arg_FREE:ptr  word 


mov 

ah,42h 

int 

67h 

;Get  logical  page  count,  dx  total. 

mov 

cx,bx 

les 

bx,[arg_TOTAL] 

mov 

[es:bx],dx 

;dx  -  total 

les 

bx,[arg_FREE] 

mov 

[es:bx],cx 

;cx  as  free 

mov 

al,ah 

xor 

ah, ah 

ret 

endp 


Iowa,  an 


int  _eiiuii_fnuDe_M^usboft  *aeg) 
returns  EMM  return  code 


s 

proc  _enun_ftame_s^ 

aig  Mrg_SEO:ptr  word 

mov 

ah,41h 

int 

67h 

;Get  page  fnme 

mov 

cx.bx 

les 

bx,[arg_SEG] 

mov 

[es:bx],cx 

;cx  B  segment 

mov 

al,ah 

xor 

ah,ah 

ret 


endp 


int  _einin_alloc(ushort  "lumdle,  ushort  peges) 
returns  EMM  return  code 


proc  _emm_aIIoc 

arg  arg_HANDLE:ptr  word,  arg_PAGES:word 


endp 


mov 

bx,[aig  PAGES] 

mov 

ah,43h 

int 

67b 

les 

bx,[arg_HANDLE] 

mov 

[es:bx],dx 

mov 

al,ah 

xor 

ah,ah 

ret 

;bx  =  pages  needed 

;Allocate  new  handle,  dx  =  handle 

;dx  -  handle 


int  _enun_realloc(ushort  handle,  ushort  pages) 
returns  EMM  return  code 


proc  _enun_realloc 

arg  arg_HANDL£:word,  arg_PAGES:word 


mov 

bx,[arg  PAGES] 

;bx  —  psges  needed 

mov 

dx,[arg_HANDLE] 

;dx  «  handle 

mov 

ah,Slh 

int 

67h 

;Resize  the  handle 

mov 

a],afa 

xor 

ah,ah 

lotfa.asa 


•m  lowa.aaa 


ret 

endp 


int  _eiiiin_ft«e(usbort  handle) 
returns  EMM  return  code 


proc  _enun_free 

arg  arg_HANDLE:wofd 

mov  dx,[a>:g_HANDLE] 

nx>v  ah,4Sh 

int  67h 

mov  al.ah 

xor  ah,ah 

ret 

endp 


;dx  s  handle 
;FrBe  the  handle 


int  _enun_handle_pages(u8hort  handle,  ushort  "^yages) 
returns  EMM  return  code 


proc  _einm_handle_pages 

arg  arg^HANDlJE:word,  arg_PAGES:ptr  word 


mov 

dx,targ_HANDLEl 

;dx  =  handle 

mov 

ah,4ch 

int 

67h 

;Get  handle’s  page  count,  bx  =  pages 

mov 

dx,bx 

les 

bx,[arg_PAGES] 

mov 

[es:bx],dx 

;dx  =  pages 

mov 

al,ah 

xor 

ret 

ah,afa 

endp 


int  _enun_map(ushort  physjMge,  ushort  handle,  ushort  page) 
returns  EMM  return  code 


proc  _emm_nup 

arg  arg_PHYS:word,  arg_HANDLE:word,  arg_PAGE:word 


mov 

ax,[arg_PHYS] 

;al  s  physical  page  number 

mov 

dx,[aig_HANDLE] 

;dx  -  handle 

noov 

bx,[arg  PAGE] 

;bx  s  page  number 

mov 

ah,44h~ 

emm  Iowa. asm 


eadp 


int 

67h 

mov 

a],ah 

xor 

ah.ah 

ret 

;Map  ooe  page 


;  int  _eiiiiii_nup_mulU(bt  phys_type,  luhort  handle,  uabort  count,  Enun_map  ^maps) 
;  returns  EMM  return  code 


proc  _einni_inap_multi  uses  si  ds 

arg  arg_7YTE:word,  arg_HANDLE:word,  arg_CNT:word,  arg_MAPS;ptr  word 


nwv 

ax,[arg  TYPE] 

;al  —  type  of  map  structure 

mov 

dx,[arg~  HANDLE] 

;dx  =  handle 

mov 

cx,[arg~CNT] 

;cx  =  page  count 

Ids 

si,[arg  MAPS] 

;ds:si  ->  mapping  structures 

mov 

ah,SOh~ 

int 

67h 

;Map  multiple  pages 

mov 

al,ah 

xor 

ah.ah 

ret 

endp 


;  int  _einiD_name_get(ushort  handle,  char  ’'name) 
;  returns  EMM  return  code 


_emm_name^et  uses  di 

arg  arg 

_HANDLE:word,  arg_NAME;ptr  byte 

mov 

dx,[arg  HANDLE] 

;dx  =  handle 

les 

di,[arg_NAME] 

;es;di  ->  name  area 

mov 

ax,ds 

mov 

es,ax 

mov 

ax,5300h 

int 

67h 

;Get  name  of  handle 

mov 

al.ah 

xor 

ah.ah 

ret 

endp 


;  int  _einm_nanie_set(U8hort  handle,  char  "name) 
;  returns  EMM  return  code 


proc  _emm_naine_set  uses  si  ds 


Iowa . asm 


emm  Iowa. asm 


arg  arg_HANDLE.'word,  arg_NAME:ptr  byte 


mov 

dx,[arg  HANDLE] 

:dx  ~  handle 

Ids 

si,[arg  NAME] 

;ds:si  ->  name  string 

mov 

ax.530lh 

int 

67h 

;Set  name  of  handle 

mov 

al,ah 

xor 

ah.ah 

ret 

;  int  _eniin_naiiie_fuid(ushort  ^handle,  char  "name) 
;  returns  EMM  return  code 


proc  _emm_name_find  uses  si  ds 

arg  arg_HANDL£;ptr  word,  arg_NAME:ptr  byte 


Ids 

si,[arg_NAME] 

;ds:si  ->  name  string 

mov 

ax,5401h 

int 

67h 

;Find  handle  by  name,  dx  =  handle 

les 

bx,[arg_HANDLE] 

mov 

[es:bx],dx 

;dx  =  handle 

mov 

al.ah 

xor 

ah.ah 

ret 

endp 

public 

_emm_version. 

_emm_pages,  _emm_frame_seg. 

_emm_alloc,  _emm_realloc 

public  _enun_frec,  _emm_handle_pages,  _emm_map,  _enun_map_multi,  _emm_name_get 

public  _emm_name_set,  _emm_name_find 

end 


emm  Iowa. asm 


•onBjnap.c 


Public  Domain 

Thomas  J.  Silva  and  The  Telemeti>  Workshop,  Inc. 

* - */ 

#include  <emm.h> 

>*. - *! 

int  emm  nuq>(Emm_handle  *this,  ushort  phys_page,  ushort  page) 

{ 

Enim_info  *info  =  this- >  info; 

if  (phys_page  >~  info->phys.pages)  return  info->last_error  =  0x8b; 

if  ((info- >  iast_eiTor  —  _emm  niap(phys_page,  this- >  handle,  page))  ==  0) 

{ 

/*—  OLD  — 

if  (info-  >  mapped[phys_page].enim  !  =  NULL) 

info-  >  mapped[phys_page].  emm-  >  pages_mapped“; 

info->mapped[phys_page].emm  =  this; 
info->mapped[physj)age].page  =  page; 
this- > pages  mapped-»--H; 

OLD  — */ 

} 

return  info- >  last  error; 

} 


aap.c 


Public  Domain 

Thomas  J.  Silva  and  The  Telemetiy  Workshop,  Inc. 

♦  - m/ 

iNnclude  <emm.h> 

♦  - */ 

int  emm_map_mu]ti(Emm_handle  *this,  int  type,  ushort  count,  Emm_map  ^teaps) 

{ 

Emm_nu^>  ''1nl^>,  ‘*'map_ead  ^  maps  -f  count; 

Emm_info  "‘info  =  this- >  info; 
ushort  physjMge; 

/* — OLD  £mm_mapped  "‘mapped;  — */ 

/* - 

"■/ 

for  (map  =  maps;  map  <  map  end;  map-h  -I-) 

{ 

if  (mi^>- > page  >=  this->pages)  return  info->last_eiTor  =  0x8a; 

phys_page  =  (type  ==  EMM_phys_segment 

?  (map->phys  -  info->phys.segments[0])  /  EMM_PAGE_PARAS 
;  map->phys); 

if  (phys_j)age  >=  info- >phys.  pages)  return  info- >  last_eiTor  =  0x8b; 

/*—  OLD  — 

mapped  =  info- >  mapped  +  phys_page; 
if  (m^ped-  >  emm  !  =  NULL) 

{ 

mapped-  >  emm-  >  pages_mapped-; 
mapped- >  emm  =  NULL; 

} 

~  OLD  —"'/ 

} 

/* - 

"■/ 

info->iast_error  —  _emm_map_multi(type,  this- >  handle,  count,  maps); 
if  (info-  >  last  error  =  =  0) 

{ 

/"•—  OLD  — 

for  (map  »  maps;  map  <  map  aid;  nu^}-!-  +) 

{ 

mapped  =  info- >  mapped 
+  (type  ==  EMM_phys_segment 

?  (map->phys  -  info->phys.segmaits[0])  /  EMM_PAGE_PARAS 


:  iiu4>->pbys); 


mapped- >ei]un  =  this; 
mapped- >  page  —  mq>->page; 
this'>pages  aiapped-f  +  ; 

} 

—  OLD  — 


return  info- >  last_error; 

} 


k«y_9«t.a«m 


ideal 

model  large,C 


codeseg 


;  key  hitO 


proc  key_hit 


mov 

ah.llh 

int 

16h 

jnz 

hit_it 

;if  ZR  ...  don’t  got 

xor 

ret 

ax,ax 

;retum  0 

hit_it: 

;else  ...  got  one 

or 

ax,ax 

jnz 

hit  ok 

;if  it  has  0  value 

mov 

hit_ok: 

ret 

alj 

;make  it  3  (control-C) 

endp 


;  key_getO 


proc  key_get 


mov 

ah,10h 

int 

16h 

or 

al,al 

jnz 

not_special 

;if  low  byte  0 

mov 

«1,1 

xcfag 

ah,al 

;higfa  is  special  code,  nx>ve  to  low  byte 

ret 

not_special: 

js 

got_exteod 

;else  if  normal  ascii 

mov 

ah,0 

;clear  high  byte  (scan  code) 

ret 

got_extend: 

;else  if  extended  key 

mov 

al,l 

;clear  low  byte  ((X)eO) 

xchg 

ah.al 

ret 

endp 


key_get.asa 


k«y_lnt9.a. 


ideal 

model  large.C 


codeseg 

bios_seg  dw  40h 

BIOS  KEYl  «  17h 
BIOS~KEY2  s  l8h 

KEY2_PAUSE  =  08h 

label  old_09  dwoid 
old_09_off  dw  0 

old_09_seg  dw  0 


proc  _kybd_my_09 


pushf 

call 

cli 

push 

mov 

and 

pop 

iret 

endp 

[cs:old_091 

ds 

ds,[cs:bios  seg] 

[BIOS_KEY2],not  KEY2_PAUSE 
ds 

9 

proc  kybd  start 

push 

ds 

mov 

ax,3S09h 

int 

21h  ;get  and  save  current  int-09  handler 

mov 

[cs:old_09_off],bx 

mov 

[cs:old_09_seg],es 

Smov 

ds,ax,cs 

mov 

dx.offset  kybd  my  09  '.install  my  09  as  int-09  handler 

mov 

ax.250% 

int 

21h 

pop 

ds 

ret 

endp 

proc  kybd_stop 

push 

ds 

k«y_int9.a8m 

k«y_int9.ai 


Ids 

dx,[cs:old  09] 

mov 

ax.2S0«i~ 

int 

21b 

pop 

ds 

ret 

endp 

public  _kybd_iny_09,  kybd_sUft.  kybd_itop 
end 


;restore  old  handler 


k0y_lnt9.aana 


p__d.a 


idMl 

model  iaffe.C 


;  void  swap_double(void  *to,  void  *from) 


pioc  swep_double  uses  si  ds 

arg  srg_TO:ptr  wofd,  srg_FROM:ptr  word 


si.[sfg_FROM] 

ax, [si] 

bx.[si+2] 

cx,[si+4] 

dx,[8i-f6] 

sl.db 

sh.dl 

bl,ch 

bh,cl 


[si],sx 

[si+21,bx 

[si+4],cx 

[si+6],dx 


;  double  swsp_doubIe_out(void  '*1irom) 


proc  swap_double_out 

arg  srg^I^OM:ptr  word 
local  temp:qwoid 


bx,[temp] 

swq>_dwble,  bx,  ss,  [arg_FROM] 
[temp] 


8wap_d.as]n 


•wap_d.am 


ret 

Mtdp 

puUic  fwap  double,  sw»p_double_out 
end 


0wap_d.asm 


«wap_f  .aoB 


ideal 

model  laise,C 


codeseg 


;  void  swap_flo8t(void  '*to,  void  *from) 


proc  swap_float  uses  si  ds 

arg  arg_TO:ptr  word,  arg_FROM:ptr  word 


ids 

si.[aig_FROM] 

mov 

ax.[si] 

mov 

dx,[si+2] 

xchg 

al,dh 

xchg 

ah.dl 

ids 

si.[arg_TO] 

mov 

tsij.ax 

mov 

[si+2],dx 

ret 

;  float  swap_float_out(void  '"from) 


proc  swap_float_out 

arg  arg_FROM:ptr  word 
local  temp:dword 


lea  bx,[temp] 

call  8wap_float,  bx,  ss,  [arg_FROM] 

fld  [teoq)] 

ret 

endp 

public  8W^)_float,  swap_float_out 
end 


8wap_f . asm 


mynp_m,mam 


idea] 

model  iarge.C 


codeseg 


;  void  swap_shoit(void  *to,  void  '*from) 


proc  swap_short 

arg  arg_TO:ptr  word,  arg_FROM:ptr  word 


endp 


ies 

bx,(arg_FROM] 

mov 

ax,(es:bx] 

xchg 

al.ah 

les 

bx,[arg_TO] 

mov 

[es:bxl,ax 

ret 

;  ushort  swap_short_out(void  *from) 


proc  swi^>_short_out 

arg  arg_FROM:ptr  word 


f 

les  bx,[arg_FROM] 

mov  ax,[es;bx] 

xchg  al,ah 

ret 

endp 

public  swap_short,  sw8p_short_out 
end 


s%«ap_s.asm 


tdbl  haa.aoB 


;  *  Public  Domain 

;  *  Thomas  J.  Silva  and  Bruce  G.  Jackson  &  Associates,  Inc. 

•  * 

9 

ideal 

model  large,C 


dataseg 

secs_per_day 

dd 

86400 

secs_per_min 

dw 

60 

one_thousand 

dw 

1000 

temp_word 

dw 

codeseg 


void  time_dbl_to_dlims(double  far*time,  Time_dluns  liur*dhms) 


NOTES: 

This  routine  was  adapted  from  the  dhms  routine  used  by  the  PCDecom  display 
application. 

I  assume  the  time  (in  seconds)  starts  at  day  0,  and  I  add  one  to  the  day, 
thus  days  are  1-365. 

Note:  I  no  longer  increment  the  day  since  elapsed  time  tends  to  get  screwed 
up  that  way.  1  just  leave  it  as  is  and  Caveat  Emptor! 


proc  tinie_dbl_to_dhms  uses  di 

arg  arg_TIME:dword,  arg_DHMS:dword 
local  var_OLD_CW:word,  var_NEW_CW:word 


;  Load  the  value  into  math  register  st(0). 

9 

les  bx,[ai:g_TIME]  ;es;bx  ->  time 

fid  [qword  ptr  es:bx]  ;load  double  into  st(0) 


Save  the  math  control  word,  it  contains  the  current  rounding  mode.  Turn 
on  round-towards-0  mode. 

Make  a  pointer  to  the  start  of  the  work  buffer.  I’ll  fill  in  from  the 
front  first. 


tdbl  hats. asm 


tdbl  tms.ai 


rounding: 

fytcw 

fwait 

[var_OLD_CW] 

;save  rounding  mode 

mov 

ax,[var  OLD  CW] 

or 

ax.OcOOfa 

;tuni  on  round-to-O  mode 

mov 

[var  NEW  CW].ax 

fldcw 

[var~NEW~CW] 

les 

di.[arg_DHMS] 

Load  a  divide-constant  into  math  register  st(0),  then  call  the  crank 
routine,  it  extracts  the  next  integer. 


fild 

tsecs_per_<lay] 

call 

crank 

;extract  days 

inc 

stosw 

ax 

;days+-f  ...  make  days  1-365 

fild 

tsecs_per_min] 

call 

crank 

;extract  total  minutes  in  day 

mov 

bx.60 

div 

bl 

;al  s  mins/60  (hours) 

xchg 

stosw 

bh.ab 

;bfa  mins%60  (minutes) 

mov 

stosw 

al.bb 

call 

stosw 

crank_half 

;extract  seconds 

;  Restore  the  rounding  mode.  Convert  and  store  the  fraction. 
» 

fldcw  [var_OLD_CW]  ;reset  rounding  mode 

fimul  [one_thousand]  ;st(0)  «  st(0) 1000 

fist  [word  es.'di]  ;store  milli-seconds 


Pop  math  register  st(0). 


ffree  st(0) 
ret 


value  in  st(l),  constant  in  st(0) 


;  inputs; 


tdbl  has. asm 


tdbl  hi&s.asm 


;  returns: 

adjusted  value  in  st(0) 

ax  s  extracted  integer  (also  in  temp_word) 

crank: 

fld 

st(0) 

;duplicate  the  constant 

fdivr 

st(0),st(2) 

;st(0)  =  st(2)  J  st(0) ...  int  =  value  /  const 

fmdint 

fist 

[temp_word] 

;store  rounded  integer 

finulo 

st(l),st(0) 

;st(l)  =  st(l)  st(0)  ...  part  =  const  int,  pop 

fsubp 

st(l).st(0) 

;st(l)  =  st(l)  -  st(0)  ...  value  -=  part,  pop 

mov 

ax,[temp_word] 

ret 

> 

;  inputs: 

value  in  st(0) 

;  returns: 

adjusted  '.alue  in  st(0) 

ax  -  extracted  integer  (also  in  temp  word) 

crank  half: 

fid 

st(0) 

;duplicate  the  value 

fmdint 

fist 

(temp_word] 

;store  rounded  integer 

fsubp 

st(l),st(0) 

;st(l)  =  8t(l)  •  st(0)  ...  value  -=  int,  pop 

mov 

ax,itemp_word] 

ret 

public  time_dbl_to_dhins 
end 


tdbl  hms.asm 


tdbl  str.aam 


;  *  Public  Domain 

;  *  Thomas  J.  Silva  and  Bnice  G.  Jackson  &  Associates,  Inc. 

•  * 

9 

ideal 

model  large.C 
include  "times.inc* 

extra  time_dbl_to_dhms:far,  time_dhms_to_string:far 


codeseg 


char  far'''time_dbl_to_string(double  far^time,  char  far*work) 

NOTES: 

This  routine  makes  this  fixed  size  string:  ‘‘ddd:hh:nun:ss.  123”,  and  needs  18 
bytes  with  which  to  work,  so  size  your  work  area  accordingly. 


proc  time_dbl_to_striing 

arg  arg_TIME:dword,  arg_WORK:dword 
local  var  DHMS:time  dhms 


;  Convert  the  time  into  dhms  integers,  then  convert  that  into  a  string. 

lea  bx,[var_DHMS] 

push  bx 

call  time_dbl_to_dhms,  [arg_TlME],  bx,  ss 

pop  bx 

call  time_dhms_to_string,  bx,  ss,  [arg  WORK] 

ret 

endp 

public  time_dbl_to_string 
end 


tdbl  str.asm 


tgp8_utc.c 


* - ■*/ 

fKnclude  <types.h> 
iKnclude  <tiiDes.h> 


The  base  date  is:  3  Jan  93,  Julian  day  3,  GPS  week  678. 

♦ - */ 

#define  BASE_YEAR  1993 
#defuie  BASE_LEAP  NO 
Mefme  BASE_WEEK  678 
#defuie  BASE  JDAY  3 
Wefine  SECs1n_DAY  86400 


* - */ 

void  tiine_gps  to_utc(Time_gps  '"gps,  double  gps_leads_utc,  Time  utc  '*utc) 

{ 

int  year  =  BASE_YEAR, 
leap  =  BASE_LEAP, 
jday  =  BASE_JDAY, 
weeks  =  gps- >  week  -  BASE_WEEK, 
wday; 
double  secs; 

/* - 

*  Compute  seconds  in  current  day,  and  day  of  week. 

*/ 

if  ((secs  =  gps- >  secs  -  gps_leads_utc)  <  0) 

{ 

weeks—; 

secs  -^=  SECS_IN_DAY  *  7; 

) 

if  ((wday  =  secs  /  SECS_IN_DAY)  >  0) 
secs  -=  (long)wday  *  SECS_IN_DAY; 


/* - 

*  Compute  Julian  day,  loop  until  it  fits  in  the  proper  year. 

*/ 

Jday  +  =  weeks  *  7  wday; 

while  (jday  <  0) 

{ 

year-; 

leap  =  (year  %  4  =  *  0  &&  (year  %  100  !=*  0  1 1  year  %  400  =  =  0)  ?  YES  :  NO); 
Jday  +«  365  +  leap; 


tgp8_iitc .  c 


tgpB_utc . c 


} 

while  (jday  >  365  +  le«p) 

{ 

jday  -=  365  +  leap; 
year+  +  ; 

leap  *  (year  %  4  *=  0  &&  (year  %  100  !*  0  ! !  year  »  400  ==  0)  ?  YES  ;  NO) 

} 


t* - - - 

*/ 

utc*>secs  =  (long)jday  *  SECS_IN_DAY  +  secs; 
utc->year  =  year; 


tgps_utc .  c 


thas  dbl.acm 


Public  Domain 

*  Thomas  J.  Silva  and  Bruce  G.  Jackson  &  Associates,  Inc. 


ideal 

model  large, C 
include  "times,  inc” 


dataseg 

one  thousand  dw  1000 


codeseg 


DHMS  equ  (time_dhms  es:bx) 

union  loog_int 

long  dd  ? 
struc 

Isw 
msw 

ends 

ends 


dw  ? 
dw  ? 


thms  dbl.asa 


thaw  dbl.am 


endp 


mov 

ax,[DHMS.days] 

mov 

dx,24 

mul 

dx 

;ax  -  days  *  24  ...  hours 

mov 

dx,3600 

mul 

dx 

;ax  =  (days  *  24)  '*  60  '*  60  ...  seconds 

add 

[seconds.lsw],ax 

adc 

[seconds,  msw]  ,dx 

;secoods  +  =  (days  *  24)  *  60  *  60 

f 

;  Ttim  hours  and  minutes  into  seconds. 

9 

mov 

ax,[DHMS.hours] 

mov 

dx,60 

mul 

dx 

;ax  =  hrs  *  60  ...  minutes 

add 

ax,[DHMS.mins] 

mov 

dx,60 

mul 

dx 

;ax  =  ((hrs  *  60)  +  mins)  *  60  ...  seconds 

add 

[seconds.  tsw],ax 

adc 

[seconds.  msw],dx 

;seconds  -f  =  ((hrs  *  60)  +  mins)  *  60 

s 

;  Load  total  seconds  into  math  chip,  load  msecs  and  adjust  it,  then  add 

;  to  get  a  total  time. 

fild 

[seconds.Iong] 

fild 

[DHMS.  msecs] 

fidiv 

[one  thousand]  ;st(0)  = 

st(0)  /  1000 

fufdp 

st(l)7st(0)  ;st(l)  * 

st(l)  +  st(0),  pop 

Store  the  final  result 


ies 

bx,[time_ptr] 

;es;bx  ->  time 

fstp 

[qword  ptr  es:bx] 

;store  double,  pop 

fwait 

ret 


public  tiiDe_dhois_to_dbl 
end 


tbas  dbl . asm 


ttaas  str.aaa 


;  *  Public  Domain 

:  '*  Tbomu  J.  Silva  and  Bruce  G.  Jackson  &  Associates,  Inc. 

ideal 

model  large.C 
mclude  ”times.inc* 


DHMS  equ  (time_dhms  bx) 


char  far^me_dhms_to_string(Time_dhms  far^dhms,  char  far*work) 

NOTES; 

This  routine  makes  this  fixed  size  string;  *ddd;hh;mm;ss.l23”,  and  needs  18 
bytes  with  which  to  work,  so  size  your  work  area  accordingly. 


proc  time_dhins_to_striflg  uses  di  ds 

arg  aig_DHMS;ptr  time_dhms,  arg_WORK;ptr  byte 


:  Make  a  pointer  Co  the  start  of  the  work  buffer.  I’ll  fill  in  firom  the 
;  front  first. 


les 

di,[arg  WORK] 

;es;di  •>  front  of  the  work  buffer 

Ids 

bx,[arg_DHMS] 

mov 

ax,[DHMS.days] 

cmp 

ax,999 

jbe 

do  day 

mov 

axr999 

do  day; 
call 

fiU_2digit 

;convert  days,  3  digits 

dec 

di 

;bsckup  to  trailing  colon 

mov 

al,’/’ 

stosb 

;add  a  slash 

mov 

ax,[DHMS.hours] 

call 

fUl_2digit 

;convert  hours,  2  digits 

mov 

ax,[DHMS.mins] 

» 

call 

fiU_2digit 

;convert  minutes,  2  digits 

thais  str.asm 


th«B  str.ana 


mov 

call 

ax.[DHMS.secs] 

fill_2digit 

;convert  seconds,  2  digits 

* 

;  Convert  the  fraction. 

• 

dec 

di 

;backup  to  trailing  colon 

mov 

stosb 

;add  a  dot 

mov 

ax,[DHMS.msecs] 

call 

fill_3digit 

;convert  milli-secs,  3  digits 

» 

;  Add  a  NULL  terminator,  return  a  pointer  to  work. 

1 

dec 

di 

;backup  to  trailing  colon 

xor 

al.al 

stosb 

mov 

dx.es 

mov 

ax, [word  arg_WORK] 

ret 


inputs: 

returns: 

wasted: 

ax  s  integer  value 

es:di  •>  work  area 

work  area  filled  with  2  or  3  digits,  di  bumped 
ax.  cl 

9 

fill_3digit: 

mov 

cl,  100 

div 

cl 

;al  =  ax  /  100,  ah  s  ax  %  100 

or 

al,’0’ 

stosb 

;*work+  +  s  al  +  ’0’ 

shr 

ax,8 

;ax  =  ah 

fill_2digit: 

mov 

cl.  10 

div 

cl 

;al  =  ax  /  10,  ah  —  ax  %  10 

or 

ax.3030h 

stosw 

;''>vork++  =»  al  +  ’O’,  ♦work+ 

mov 

stosb 

;*work++  *  : 

ret 

public  tiiDe_dhiiis_to_string 
end 


tfams  BtX 


tlMr.ai 


ideal 

model  iarge.C 


codeseg 


;  void  rtc_timer_set(ushort  insec_coiint,  ubyte  ^flag) 


proc  rtc_timer_set 

arg  arg_MSECS:wotd,  arg_FLAG:ptr  byte 


les 

bx,[arg_FLAG] 

mov 

ax.[arg  MSECS] 

mov 

dx.lOOO 

mul 

dx 

mov 

cx.dx 

mov 

dx.ax 

mov 

ax.8300h 

int 

15h 

ret 

endp 

public 

rtc_timer_set 

end 

;es:bx  ->  flag,  non-zero  when  done 


;cx_dx  s  micro-seconds 
;start  timer  service 


timer. asm 


V  chttck.e 


♦ - *! 

#uicliide  <iiMth.h> 

jKncliide  <vecu>r.h> 


■* - */ 

int  vector_check(Vector  Vector  limits  *liiiiit) 

{ 

double  mag; 

if  (fabs(v->x)  >  limit->hi 
j|  fid»s(v->y)  >  limit->hi 
1 1  fabs(v->z)  >  limit- >lu)  return  NO; 

mag  s  vector_magaitude(v); 

if  (mag  <  limit- >  low  1 1  mag  >  limit- >  hi)  return  NO; 
return  YES\ 

} 


SC  ss  ss  as  s  : 


♦ - */ 

int  state  vector_check(State  vector  State  vector  limits  *limit) 

{  ■ 

return  vector  cbeck(&v->pos,  delimit- >  pos)  &&  vector  cbeck(&v->vel,  &limit->vel) 

} 


V  ch«clc.c 


v_j2000.c 


*  These  functions  convert  the  Shuttle  state  vector  between  M50  Inertial 

*  coordinates  and  J2000  inertial  coordinates  (and  back  again). 

* 

*  NOTE:  This  really  does  BSO,  not  MSO,  but  they  are  close. 

♦  - */ 

iKnclude  <math.h> 

ii^iude  <  vector.  h> 

^include  <const.h> 


* - */ 

static  double  j2000_bS0[3][3]  » 

{ 

.9999256794956877.  .0111814832391717,  .0048590037723143. 
-.0111814832204662.  .9999374848933135,  -.0000271702937440. 
-.0048590038153592,  -.0000271625947142,  .9999881946023742 

}: 


* _ */ 

void 

state  vector  mSO  to_j2000(State  vector  *m50.  State  vector  *j20(X)) 

(  ■  " 

double  b50J2000[3]I3]: 

nMtrix_tnuispose(j20(X)_b50,  b50J2000); 
vector_transform(&mS0- >  pos,  &j2000->pos,  b50J2000); 
vector_transfonn(&m50->vel,  &j2000->vel,  b50_j2000); 

} 


♦ _ */ 

void 

state  vector  i2000  to  m50(State  vector  "52000,  State_vector  *in50) 

{ 

vector_transfonn(&j2000-  >  pos,  &m50-  >  pos,  j^X)0_b50); 
vector  transfonn(&j2000->vel,  &mS0->vel,  j2(X)0_b50); 

} 


v_j2000.c 


V  mSO.c 


/♦» 


*  These  functions  convert  the  Shuttle  state  vector  between  MSO  Inertial 

*  coordinates  and  ECEF  coordinates  (and  back  again). 

* 

*  NOTE:  Values  may  be  in  any  units,  and  time  must  be  UTC. 

♦  - */ 

^include  <matb.h> 


#include  <  vector.  b> 
#include  <const.h> 


♦ - */ 

void 

state_vector_rotate_m50_ecef(State_vector_transform  ^‘m50_eccf, 

double  new_tiine. 

State  vector_transform  ’*^f_mSO) 

{ 

double  c_lam,  sjam,  lambda; 
ecef_m50->time  =®  new_time; 

lambda  =  EARTH_OMEGA  *  (new_time  -  m50_ecef->time); 
cjam  —  cos(lambda); 
sJam  =  sin(lambda); 


ecef_m50-  >  matrix[0][0] 
ecefmSO-  >  matrix[0}[  1  ] 
ecef_m50-  >  matrix[0][2] 


m50_ecef- >  matrix(OJlO]*c_lam  +  m50_ecef->matrix[l][0]*s_lam; 
-m50_ecef->malrix[0J[0]*s_lam  +  m50_ecef->matrix[l)[01*c  Jam; 
m50_ecef-  >  matrix[2][0]; 


ecef_m50-  >  ntttrix[  1 1(0] 
ecef_m50- >  matrix[  1  ][  1  ] 
ecef_ni50-  >  m8trix[  1  ][2] 


m50_ecef-  >  matrix[0][  1 1'tjam  +  m50_ecef-  >  matrix[  1  ]( 1  ]‘''s_lam; 
-m50_ccef->matTix[0][l]*s_lam  +  m50_ecef->malrix[l](l]'*c_lam; 
m50_ecef-  >  matrix[2][l]; 


ecef_mS0*  >  matrix[2][0] 
ecef_mS0*  >  matrix[2][l] 
ecef_m50-  >  matrix[2][2] 


m50_ecef->matrix[01[2]*c_lam  +  m50_ecef->matrix[ll(2]'H_lam; 
-m50_ecef->matiix[0](2]*s_lam  +  m50_ecef->matrix[l](2]*cjam; 
mS0_ecef-  >  matrix[2][2]; 


* - */ 

#ifdefGIGO 

static  sbow_vector(cbar  "title,  Vector  *v) 

{ 

printf{"%s\t%201f  %201f  %201f\n",  title,  v->x,  v->y,  v->2); 

} 


V  aSO.c 


V  mSO.c 


static  show_matrix(char  ^title,  double  in[3][3]) 

{ 

static  char  fintQ  s 

''%sVt%20lf  %20lf  %20lfVD'' 

■\t\t%20lf  %201f  %201f\n* 

''\t\t%20lf  %201f  %201f\n''; 

printf(fait,  title, 
mlOlIO],  mI01[l],  tn[0][2], 
m[l][0].  m[l][l].  in[lK2]. 
in[21[0].  inI21(l].  m[2]t2]); 

} 

#endif  GIGO 

Note:  Velocity  may  be  an  inertial  velocity  expressed  in  ECEF  coordinates. 
Otherwise  it  is  an  ECEF  velocity,  expressed  in  ECEF  coordinates. 

* _ *! 

void 

state_vector _ m50_to_ecef(State_vector  *ni50,  State_vector  *ecef. 

State  vector  transform  *mSO  ecef  epoch,  int  vel  is  ecef) 

{ 

Vector  omega,  omegaXr,  vrel; 

State_vector_transfonn  ecef_m50,  m50_ecef; 

/* - 

♦/ 

state_vector _ rotate_m50_ecef(m50_ecef_epoch,  mSO->time,  &ecef_m50); 

if  (vel_is  ecef) 

{ 

omega.x  =  EARTH_OMEGA  *  ecef_mS0.matrix[0][2]; 
omega.y  =  EARTH_OMEGA  *  ecef_mS0.matrix[l][2]; 
omega.2  =  EARTH_OMEGA  *  ecef_m50.matrix[21[2]; 

vector_cross(&omega,  &mSO->po£,  &omegaXr); 
vector_diff(&mSO->vel,  dcomegaXr,  &vrel);  //  mSO  -  omegaXr 

} 

else  vrel  =  m50*>vel; 

/* - - 

*! 

matrix_transpose(ecef_mSO.matrix,  m50_ecef. matrix); 
vector_trBnsfoni^&m50->pos,  &ecef->pos,  m50_ecef.matrix); 
vector_transform(&vrel,  &ecef->vel,  mM_ecef.  matrix); 


V  aiSO.c 


V  bSO.c 


* - */ 

void 

state  vector  ecef  to  m50(SUte  vector  *ecef,  Sute_vector  *m50, 

State_vector_tnuisfonn  *mSO_ecef_epoch,  int  vel_is  ecef) 

{ 

Vector  omega,  omegaXr; 

State_vector_tnnsform  ecef_iiiSO; 

/* - 

state_vector _ rotate_in50_ecef(iii50_ecef_epoch,  ecef- >  time,  &ecef_inSO); 

vector_transfonn(&ecef->pos,  &mSO->pos,  ecef_inSO.matrix); 
vector_transfonn(&ecef- >  vel,  &oj50->vel,  ecef_mSO. matrix); 

/* - 

*/ 

if  (vel  is_ecef) 

{ 

omega.x  =  EARTH_OMEGA  *  ecef_mS0.matrix[0][2]; 
omega.y  =  EARTH  OMEGA  *  ecef_tnS0.matrix[l][2]; 
omega.z  =  EARTH_OMEGA  ecef_m50.matrix[2][2]; 

vector_cross(&omega,  &m50->pos,  &omegaXr); 
m50->vel.x  +*  omegaXr.x;  //  m50  +  omegaXr 
m50->vel.y  +=  omegaXr.y; 
m50->vel.z  -f®:  omegaXr.z; 

} 

} 


V  mSO.c 


V  aatrix.c 


iKnclude  <iiuith.h> 
finclude  <vector.h> 


Both  in_ui  and  m_out  may  be  the  same  matrix. 

■c - 1 - */ 

void  matrix_transpose(double  m  in[3][3],  double  m  out[3][3]) 

{ 

if  (m_in  =  =  m_out) 

{ 

double  te^^); 

temp  =  m_out[0][ll;  m_out[0][l]  =  ni_out[l][0];  m_out[l]tO]  =  ten^); 

temp  =  m_out[0][2];  m_out[0][2]  =  m_outt2][0];  m_out[2][0]  =  temp; 

temp  =  m  out[l][2];  m_out[ll[2]  =  m  out[2][l];  m_out[2][l]  =  ten^; 

} 

else 

{ 

int  row,  col; 


} 


for  (row  =  0;  row  <  3;  row++) 
for  (col  as  0;  col  <  3;  col++) 

m_out[row][col]  =  m_in[col](fow]; 


I  compute  the  INERTIAL  to  LVLH  transform  matrix  given  an  inertial  vector. 
This  is  a  standard  post-multiply  matrix,  where  VI  a$  m  vi,  and  Vi  is  a  colunm. 

♦ - */ 

int  state  vector_itol_matrix(State_vector  "'sv,  double  matrix[3][3]) 

{ 

Vector  temp; 

/• - 

*1 

temp.x  s  -sv->pos.x; 
temp.y  =*  -sv->pos.y; 
temp.z  =  -sv->pos.2; 

if  (vector_unit(&temp,  (Vector  ''0matrix[2])  s  s  NO)  return  NO; 

vector_cross(&sv->vel,  &sv->pos,  &temp); 
if  (vector_unit(&tenq>,  (Vector  ''')matrix[l])  ==*  NO)  return  NO; 


V  aiatrlx.c 


V  matrix,  c 


v«;tor_cioi8((Vector  *)aiatrix[l],  (Vector  •)niatfix(21,  &teinp); 
if  (vecU>r_uiut(&teinp,  (Vector  *)nMtrix[0])  «  *  NO)  return  NO; 

return  YES; 


V  matrix,  c 


v_quat.c 


*  See  vector,  h  for  a  discussion  of  quaternion  order  and  direction. 

*  - 

^include  <nHUh.b> 

#include  <vector.b> 


• - */ 

void  quatemi<Mi_conjugate(Quatemion  ^ 

{ 

q->x  =  -q->x; 

q->y  =  ^.>y; 

q->z  s=  -q->z; 

} 


Quaternion  multiply  order  is  reversed  from  matrix  multiply,  but  matrix 
multiply  is  not  straightforward  either,  so  read  on. 

* 

*  If  you  have  transforms  from  A*to-B  and  B-to-C,  then  the  matrix  equation 

*  will  be:  Vc  =•  M_btoc  ♦  M_atob  ♦  Va,  remember:  the  vector  is  post-multiplied 

*  as  a  column,  and  the  result  Vb  is  post-multiplied  again. 

*  The  corresponding  quaternion  equation  is:  Vc  =  Va  ♦  Q_atob  *  Q_btoc. 

♦. - 1*/ 

//void  quaternion  mult(Quatemion  *ql.  Quaternion  '*'q2.  Quaternion  "'qout) 

//{ 

//  qout->s  *  (ql->s  ♦  q2->s)  -  (ql->x  *  q2->x)  -  (ql->y  "■  q2->y)  -  (ql->z  *  q2->z); 

//  qout->x  =  (ql->s  *  q2->x)  +  (ql->x  *  q2->s)  +  (ql->y  q2->z)  -  (ql->z  *  q2->y); 

//  qout->y  =  (ql->s  *  q2->y)  -  (ql->x  *  q2->z)  +  (ql->y  "■  q2->s)  +  (ql->z  *  q2->x); 

//  qout->z  =  (ql->s  *  q2->z)  +  (ql->x  *  q2->y)  -  (ql->y  *  q2->x)  +  (ql->z  *  q2->s); 

//} 


*  This  routine  creates  a  direction-cosme  matrix  from  a  quaternion.  The 
matrix  is  computed  in  the  "direction”  of  the  quatonion:  if  the  quaternion 

'*  is  body-to-inertial  then  the  matrix  denotes  the  rotation  from  the  body  frame 
'*  to  the  inertial  frame. 

* 

'*  NOTE:  See  vector.h  about  NASA  quaternion  twist  direction.  As  as  result  of 
the  reversed  definition,  all  the  oibiter  code  that  I’ve  seen  has  reversed 

*  signs  on  die  non-squaied  dements  (the  same  as  transposing  the  matrix). 

* 

*  2  2  2  2 

*  mOO  «s  +  x-  y-  z  mOl  ®  +  2sz  m02  =  2xz  -  2sy 

* 


v_quat.c 


v_qtt«t.c 


* 

2  2  2  2 

*  mlO  »  2xy  -  2sz 

41 

mil  « 

8  -  X  +  y  -  z 

ml2  *  2yz  +  28X 

* 

2  2  2  2 

*  m20  »  2xz  +  2sy 

A 

m21  s  2yz  -  2sx 

m22  s®8-x-y  +  z 

*  Equivalent  diagonal  elements: 

•  2  2 

2  2 

2  2 

"■  mOO  *  1  -  2y  -  2z 

mil  « 

1  -  2x  -  2z 

11122  =  1  -  2x  -  2y 

* 

A/ 

void  quaternion  to  ntttrix(Quatemion  'N},  double  niatrix[3][3]) 

{ 

double  ss  s  q.>s  *  q->s; 
double  XX  *  q->x  q->x; 
double  yy  *  q->y  *  q->y; 
double  zz  =  q->z  *  q->z: 
double  xy  =  q->x  *  q->y; 
double  xz  =  q->x  *  q->z; 
double  yz  =  q->y  *  q->z; 
double  sx  =  q->s  q->x; 
double  sy  =  q->s  *  q->y; 
double  sz  =  q->s  *  q*>z; 

inatrix[0][0]  3:ss-t-xx*yy*zz; 
inatrix(0][l]  «  2  *  (xy  +  sz); 
a)atrix(0][2]  >=  2  "■  (xz  -  sy); 
nuitrix[l][0]  =  2  *  (xy  -  sz); 
ii»bix[l][l]  =  ss*xx-fyy-zz; 
inatrix[I][2]  =  2  *  (yz  +  sx); 
nutrix[2][0]  =  2  "■  (xz  +  sy); 
inatrix[2](l]  =  2  *  (yz  -  sx); 
niatrix[2][2]  s^ss-xx-yy  +  zz; 

} 
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♦ - *! 

iKnclude  <iiialh.h> 

iKncliide  <vector.h> 


*  This  routine  produces  the  position  vector  from  one  state  vector  (target)  to 
'*  another  state  vector  (chaser).  The  inputs  are  assumed  to  be  in  GCI,  and  the 

*  output  is  returned  in  the  LVLH  of  the  principle  state  vector  (target). 

* 

*  Vector  rv 

X  =  vbar,  positive  forward 
y  =  hbar,  positive  "north" 
z  sc  rbar,  positive  down 

* 

"■  Vector  rvdot 

*  X  s  magnitude  of  (position  difference  vector) 

*  y  =  ydot 

*  z  s  closure  rate 

*  - *! 

void  vector  rvbar(State  vector  ^target.  State  vector  "Phaser,  Vector  *rv,  Vector  *rvdot) 

double  mag_tpos,  magxxv,  magvbar,  lcg[3][3],  w; 

Vector  xtxvt,  hhat,  mhhat,  vb,  xop,  dif,  rvbdif,  omega,  vdifi,  vdifi,  rdot,  wxr; 
double  hbar,  vbar,  rbar,  cos_theta,  eta; 

/* - 

♦/ 

mag_tpos  =  vector_magnitude(&taiget->pos); 

lcg[2][0]  =  -target- >pos.x  /  mag_tpos; 
lcg[2][l]  =  -target- >  pos.y  /  mag_tpos; 
lcg[2][2]  =  -target- >pos.z  /  mag_tpos; 

f* - 

*1 

vector_cross(&target->pos,  &target->vel,  &xtxvt); 
magxxv  3s  vector_magnitude(&xtxvt); 

lcg[l][0]  sr  nihhat.x  =  -(hhat.x  —  xtxvt.x  /  magxxv); 

lcg[l][l]  s  mfahat.y  »  -(hhat.y  s  xtxvt.y  /  magxxv); 

lcg[l][2]  s  mhhat.z  =  -(hhat.z  ^  xtxvt.z  /  magxxv); 

hbar  ^  vector_dot(&hhat,  &chaaer->pos); 
vector_cross(&target->pos,  Anihhat,  &vb); 

xop.x  K  chaser- >pos.x  -  lifaat.x  *  hbar; 
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xop.y  B  cliaaw>>pot.y  •  hhat.y  *  hbar; 
xop.z  «  chc9er->po3.z  •  hhat.z  *  bbar. 
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/* - 

*/ 

cM^dieU  »  vector_dot(&xop,  &tarse(>>pos)  /  mag^tpos  /  vector_iiuigiutude(&xop); 

if((cos_tfaeU  >  1.0)  &&  (cos_tlieta  <  1.05)) 
eU  «  0.0; 
else 

eU  »  scos(vector_dot(&xop,&target->pos)  /  mag_tpos  /  vector_insgnitiide(&xop)); 
vbar  s  mag^^pos  *  eU; 

rbar  »  mag^tpos  -  vector_iiiagiiitude<Achaser->pos): 

/* - 

*/ 

magvbar  —  vector_inagiutude(&vb); 

lcg[0][0]  s  vb.x  /  magvbar;  dif.x  »  chaser->pos.x  •  target- >pos.x; 

lcg(0][l]  a:  vb.y  /  magvbar;  dif.y  «  chaser- >pos.y  -  target- >pos.y; 

lcg[0][2]  ^  vb.z  /  magvbar;  dif.z  »  chaser- >  pos.z  -  target- >pos.z; 

vectorJraasfomK&dif,  &rvbdif,  leg); 

/• - 

*/ 

if  (rvbdif.x  <  =  0)  vbar  »=  -vbar; 

rv->x  »  vbar; 
rv->y  «  -hbar; 
rv->z  «  rbar, 

/* - 

*1 

vdifi.x  «  cbaser->vel.x  -  taiget->vel.x; 
vdifi.y  *  chaser- >vel.y  -  target- >vel.y; 
vdifi.z  <B  chaaer->vel.z  -  target- >vel.z; 

vector_traiisform(&vdifi,  &vdifl,  leg); 

w  m  magxxv  /  vect(»’_dot(&taiget->pos,  &target->pos); 
omega.x  »  omega.z  »  o.O;  omega.y  —  w; 

vector_cross(&omega,  Arvbdif,  &wxr); 

rdot.x  *  vdifl.x  +  wxr.x; 
rdot.y  *  vdifi.y  +  wxr.y; 
rdot.z  *  vdifi.z  -f  wxr.z; 
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/* - 

*/ 

rvdot->y  *  rdot.y; 

rvdot->x  «  vector_OMigiutiide(&rvbdif); 

if  (rvdot->x  >  l.Oe-8)  fvdot*>z  «  -vector_dot(&Rlot,  &rvbdiO  /  rvdot-> 
else  rvdot*>z  «  0.0; 
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* - */ 

ffiaclude  <iQath.h> 

jKnclude  <vector.h> 


* _ _ .... - - - - - 

double  vector  maguitudeCVector  '*v) 

{ 

return  sqrt(v->x  *  v->x  +  v->y  *  v->y  +  v->z  *  v->z); 

) 

int  vector  uiut(Vector  '*Vin,  Vector  *vout) 

{ 

double  mag; 

if  ((mag  as  vector_magnitude(vm))  ^ »  0.0)  return  NO; 

vout->x  —  vin->x  /  mag; 

vout->y  =  vin->y  /  mag; 

vout*>z  s  vin->z  /  mag; 

letum  YES; 

} 


♦ _ */ 

double  vector  dot(Vector  *vl,  Vector  *v2) 

{ 

return  (vl->x  "■  v2->x  +  vl->y  "■  v2->y  +  vl->z  "■  v2->z); 

} 

void  vector  cross(Vector  "'vl.  Vector  *v2.  Vector  *vout) 

{ 

vout->x  =  vl->y*v2->z  -  vl->z*v2->y; 
vout->y  =  vl->z''V2->x  -  vl->x''V2->z; 
vout->z  =  vl->x*v2->y  -  vl->y*v2->x; 

} 


*  This  post-multiplies  a  matrix  with  a  COLUMN  vector  Vout  =  M  Vin. 

*  - */ 

void  vector  traiisforni(Vector  *vin.  Vector  *vout,  double  tnnsfonn[3][3]) 

{ 

vout->x  “  vector_dot(vin,  (Vector  ''')&tnnsfonn[0][0]); 
vout->y  »  vector_dot(vin,  (Vector  *)&transform[l][0]); 
vout->z  B  vector  dot(vin,  (Vector  *)&tFBnsform[2][0]); 

} 
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* _ _ _ _ */ 

void  vector  diff(Vector  ■Nl,  Vector  *v2,  Vector  ♦vout) 

{ 

vout->x  =  vl->x  -  v2->x; 
vout->y  =  vl->y  -  v2->y; 
vout->z  =  vl->z  -  v2->z; 

} 

//void  vector  eddCVector  "vl.  Vector  ♦v2.  Vector  *vout) 

//{ 

//  vout->x  =  vl->x  +  v2->x; 

//  vout->y  =  vl->y  +  v2->y; 

//  vout->z  =  vl->z  +  v2->z; 

!/) 
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'*  Public  Donudn 

*  Thomas  J.  Silva  and  Bruce  G.  Jackson  St  Associates,  Inc. 

* 

* - *! 

Sifadef  COM_PORT_ 

#define  “  COM~  PORT_ 

#include  <types.b> 


These  are  the  only  user-callable  routines,  all  the  others  are  for  internal 
"■  use  only. 

* - */ 

extern  int 

comjf>ort_start(int  port_id,  ushort  rx_bsizB,  ushoit  tx_bsize), 
com_port_stop(int  port_id), 

comjx>rt_set(int  port_id,  long  baud,  int  parity_flag,  int  stop_bits), 
comjx)rt_jet(int  port_id), 
com_port_put(int  port_id,  ubyte  value), 
eomjx>rt_read(int  port_id,  ubyte  *where,  int  size), 
com_port_write(int  port_id,  ubyte  "^vhere,  int  size); 


Mefine  COM_PCMlTjpar_none 

0x00 

#define  COM_PORT_par_even 

0x18 

#define  COmIpORT  par'odd 

0x08 

#define  COM_PORT_stop_l 

0x00 

#define  COM_PORT_stop_2 

0x04 

Head  and  tail  are  offsets  from  the  buffer  start. 

* - •»/ 

typedef  struct 

{ 

ushort  size,  used,  head,  tail; 
ubyte  ’"start; 

}  Comj)ort_buffer; 


This  structure  is  used  for  actual  interrtqrt-handler  entry  points.  The 
*  structure  contains  several  instructions,  all  of  which  must  be  initialized, 
and  (me  of  which  must  be  set  with  the  common-handler  address. 

06  pudi  es 
53  push  bx 
■"  90  nop 
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9m  calif  SEG;OFF 


_ _ _ _ _ _ 

typedef  struct 

{ 

ubyte  op_es,  op_bx,  op_nop,  op_call: 
ushort  offwt,  segment; 

}  Com_port_Mitiy; 


- *! 


*  Note:  If  you  change  COM_PORT_niax,  thoi  you  must  change  an  airay  in  the  C 
source  file. 

*  - *1/ 

^define  COM_PORT_max  4 

typedef  struct 

{ 

Com_port_entiy  entiy; 
ushort  status,  port; 
ubyte  trq,  irq_mask; 

Com_port_buffer  rx,  tx; 
void  (far*oId_handler)(void); 

}  Comjx>rt_info; 

#define  COM  PORT  In  use  0x0001 

#defioe  COM“pORT' iri.was  off  0x0002 

#define  COM  PORT  rx  enabled  0x0010 
#define  COM~PORTltx“enabled  0x0100 
fdefine  COM_PORT_tx_stopped  0x0200 

#define  COM_PORT_clock  1843200L 

/♦ - */ 

extern  int 

_comjport_reset(Com_jx)rt_info  *port), 

_comjport_get(Com_port_info  "^rt), 

_com_port_put(Com_port_info  *port,  ushort  value); 

extern  void 

_com_port_set(Com_port_info  *port,  ushort  divisor,  int  parity_flag,  int  stop_bits), 
_com_port_intr_catch(Com_port_info  *port), 
_ccm_poit_intr_uncatch(Com_port_info  *port); 

#endif_COM_PORT_ 


com_port.h 


com_port . inc 


%nolist 


;  ^  Public  Domain 

;  *  Thomas  J.  Silva  and  Bruce  G.  Jackson  &  Associates,  Inc. 

•  * 


union  Far  j)tr 

ptr  dd  ? 

struc 

off  dw  ? 

seg  dw  ? 

ends 

ends 

struc  Com_port_entry 

op_es  db  ? 

op_bx  db  ? 

op_nop  db  ? 

op_call  db  ? 

handler  Far_ptr  <  > 

ends 

OP  PUSH  ES  =  06h 
OP“pUSH"bX  =  53h 
OP'nOP  ‘  =  90h 

OP~  CALLF  =  9ah 


struc  Com_port_buffer 

bsize 

dw  ? 

bused 

dw  ? 

bhead 

dw  ? 

btail 

dw  ? 

bstart 

Far_ptr  <  > 

ends 

struc  Com_port_info 

entry 

Comjx)rt_entry  <  > 

status 

dw  ? 

port 

dw  ? 

irq 

db? 

irq_mask 

db? 

rx 

Com_port_bufTer  <  > 

tx 

Comjx)rt_buffer  <  > 

comjport . Inc 
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oid_haiidler  Far_ptr  <  > 

ends 


COM  PORT  in  use  »  OOOlh 

COM”pORT~ iri^wss_off  -  0002h 

COM~PORT~ rx  enabled  »  OOlOfa 

COM~PC»RT~ tx'enabled  »  OlOOh 

COM"PC»T~ul8topped  =  0200h 


I 

macro  ACC_WR  Reg,Inst,Val 


mov 

ah.dl 

add 

dl.Reg 

Inst  al.Val 

out 

dx.al 

mov 

dl,ah 

endm 

macro  ACC_RD  Reg 

mov 

ah.dl 

add 

dI.Reg 

in 

al,dx 

mov 

dl,ah 

endm 


PC_int_irqO 

»  08h 

PC_int_irq8 

=  70h 

PC  ICO  lO 

=  20h 

PCJCO^rl 

-  21h 

PC  ICl  lO 

»  OaOh 

PC_ICl_rl 

Oalh 

IC  eoi 

«  20fa 

ACC_rwl_int_niitat 
ACC_fw  l_int_lstat 
ACC_rwl_uit_tx 
ACC  r<*'l  int  rx 


00001000b 

00000100b 

-  00000010b 
s  00000001b 


coni_port.inc 


con_port.lnc 


ACC_r2_int_peiidiDg 

ACC_f2_iiit_typc 

«  00000001b 

«  00000110b 

ACC_w2_ni_fifo_  1 

ACC_w2_ni_fifo_4 

ACC_w2_rx_fifo_8 

ACC_w2_nt_fifo_14 

ACC_w2_dma_m^e 

ACC_w2_tx_crr 

ACC_w2_rx_cIr 

ACC_w2_fifo_on 

«  00000000b 
«  01000000b 
e  10000000b 
>=  11000000b 

«  00001000b 
«  00000100b 
«  00000010b 

«  00000001b 

ACC_rw3_dlab 

ACC_rw3_bfeak 

ACC_rw3_par_flip 

ACC_rw3_par_even 

ACC_nw3_par_enab 

ACC_rw3_2stop 

ACC_rw3_8bits 

a  10000000b 

01000000b 
«  00100000b 
=  00010000b 
~  00001000b 
a  00000100b 
-  00000011b 

ACC_fw4_loopback 
ACC_rw4_output2 
ACC_rw4_ou^ut  1 
ACC~fw4"RTS 
ACClfw4"DTR 

-  00010000b 

=  00001000b 
=  00000100b 
=  00000010b 
=  00000001b 

ACC_r5_tx_eii^rty 

ACC_r5_rx_«vail 

«  00100000b 
00000001b 

%iist 

co(m_port.lnc 


const,  h 


*  This  package  provides  mathematical  constants. 

* 

*  Note:  Some  of  these  are  already  defined,  with  different  names,  in  math.h. 

* 

"■  Author: 

Robert  Gottlieb,  August,  1989 
Modified: 

*  Lee  Barker,  Mar  93 

*  TJ  Silva,  Mar  93 

* 

*  Knuth,  D.E.,*The  Art  of  Computer  Programing:  Vol.2  Semi-Numerical 

*  Algorithms,”  Addison-Wesiey  Pub.  Co.,  2nd  Ed.,  1981. 

* 

Selby,  S.M.,  "Standard  Mathematical  Tables,”  The  Chemical  Rubber  Co., 
20th  ed.,  18901  Cranwood  Parkway,  Cleveland  Ohio,  1972. 

* 

* - */ 

#ifhdef_CONST_ 

#define _ CONST 

/*  —  Define  machine  constants  —  */ 

#define  BIG  1.0e4-20 

#define  SMALL  l.Oe-20 

#defuie  TIME_TOL  l.Oe-06 


/*  —  Defining  Omstants  —*/ 

fdefine  fl  3.141S926S358979323846 

#define  NATURAL_LOGARITHM_BASE  2.718281828459045235 

#define  EULERS_NUMBER  NATURAL_LOGARITHM_BASE; 


/*  —  Derived  Constants  —  •/ 


Mefine  SQUARE_ROOT  OF  TWO 
(Mefine  SQUARE  ROOT~ OF~ THREE 
#define  SQUAREIrOOT” OF" FIVE 
Sdefine  SQUARE  ROOT~ TEN 


1 .41421356237309504880 
1.73^)50807568877293 
2.236067977499789696 
3.162277660168379331 


HUefine  CUBE  ROOT_TWO  1.259921049894873164 

#defiiie  CUBE~ ROOT  THREE  1 .442249570307408382 

fdefine  FOURTH  ROOT  TWO  1.189207115002721066 


#define  NATURAL  LOG  TWO 
#define  NATURAL~LOG~THREE 
Mefine  N  ATURAL~LOG~TEN 
#define  N  ATURAL”lOG~PI 


0.693147180559945309 

1.098612288668109691 

2.302585092994045684 

1.144729885849400174 
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#defiiie  BASE  TEN  LCX3  PI  0.497149872694133854 

#defuie  PI  SQUAR]^  9.869604401089358618 

fdefiiK  PI JNVERSE  0.318309886183790671 

define  HALF  PI  (  PI  /  2.0  ) 

Mefine  TWOjPI  (  PI  *  2.0  ) 

fdefine  NATURAL  LOGARriHM  BASE  INVERSE  0.367879441171442321 
Mefiiie  NATURALIlOGARITHM'baSeIsQUARED  7.389056098930650227 


Mefiiie  DEGREES  (n/180.0) 

#defiiie  OBUQUITY  (23.45  *  DEGREES) 


#define  TRUE  1 

#defuie  FALSE  0 

Sdefiiie  ON  1 

#defuie  OFF  0 


/*4‘**<ti**************m******'¥***‘*********m*'¥*^'0******************************’¥/ 

/*  Additional  constants  added  by  Lee  Barker  for  STS-51  software  */ 

/m*****************************<¥*****’*:*****0*********************m**m********/ 

Meftiw  YES  1 
fdefine  NO  0 

fdefine  FT  TO_M  0.3048 

iMefine  HLOFT  TO  KILOM  (FT  TO  M) 
fdefine  FT_TO_klLOM  (FT_TO_M/ToOoTo) 

iMefine  M  TO  FT  (1.0/FT  TO  M) 

#define  ioLoM  TO  HLOFT  (M  TO  FT) 

IMefine  nLOM_TO_FT  (M_TO_FT*10(jo.O) 

iMefine  RAD  TO_DEG  (180.0/n) 
iMefine  DEG~TO_RAD  (Pl/180.0) 

IMefine  EARTH  RADIUS_HLOM  6378.139 

IMefine  EARTH^OMEGA  7.2921 1514646e-5 

iMndif  CONST 
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/* 


*  -  _ _ _ _ _ •/ 

#ifedcf_EDrr_ 
fdefine  _EDn'_ 

extern  char 

■*edit_text(diar  *label,  diar  ^initial); 
extern  int 

edit_uitegeKchar  *label,  int  initial); 
extern  long 

edit_integer_long(char  ‘"label,  long  initial); 

#endif_EDIT_ 
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* - */ 

iKAidef  EDIT  RT 
Idefine  EDIT  RT 


* - ♦/ 

typedef  struct 

{ 

int  row,  col; 
char  ’''string; 

}  Editjabei; 


*  The  field  callback  functions  take  these  arguments: 

* 

*  getfchar  ’'Work,  void  "’data) 

"■  put(char  'Nvork,  void  "’data) 

"'  key(Edit_field_info  "4nfo,  int  key) 

♦  ~  ~ 

*  woric:  pointer  to  start  of  work  string,  80  chars  max 
"'  data:  pointer  to  some  piece  of  data,  field  specific 

"*  info:  pointer  to  field-in-progress  information 

key:  key  value 


"'  The  get  function  must  convert  its  data  into  a  string.  It  must  return  the 
"’  cursor  offset  as  follows: 

"’  <  0  Put  the  cursor  past  the  end  of  the  string 

"'  >  s  0  Put  the  cursor  somewhere  in  the  string  (0  for  start  of  string) 

* 

*  The  put  function  must  convert  back  from  a  string,  it  may  return: 

"'  0  No,  string  bad  garbage  (reset  my  field) 

"'  1  Ok,  convert  successful 

* 

*  The  key  fimction  must  behave  somewhat  like  otiier  key  handlers: 

"'  0  Didn't  use  the  key 

"'  1  Used  the  key 

"'  2  Used  the  k^  (reset  my  field) 

♦  - */ 

typedef  struct 

{ 

char  ">vork; 

int  changed,  size,  cursor  offset; 

}  Edit_field_infb; 


typedef  struct 

{ 
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int  row,  cd; 

iot  (*fetKchtf  *,  void  *); 
int  (*|putXclMr  *,  void  •); 
int  C'ic^XEdit^field^info  *,  int); 
vdd  'Mata; 

}  Edit_fieid; 

/* - •/ 

extern  void 

edit_field_insert(Edit_fieId_infb  *info,  int  key); 
extern  int 

edit_field_kcy_handler(Edit_field_infb  '*info,  int  key), 

edit_field_get_int(cbar  Mrork,  void  Mata), 
edit_field_put_int(char  '^vork,  void  ''data), 
edit_field_key_int(Edit_field_info  "info,  int  key), 

edit_field_^get_dbl(char  "^vork,  void  Mata), 
edit_fieldjNit_dbl(char  *work,  void  Mata), 
edit_field_key_dbl(Edit_fie]d_info  'Mifo,  int  key), 

edit_fieldjgiet_yeano(cliar  ''>vofk,  void  'Mata), 
edit_field_put_yeano(char  'Mroric,  void  *data), 
edit_field_key_ye8no(Edit_field_info  "info,  int  k^^), 

edit_fieldj|et_dhnuiO(char  "Voik,  void  Mata), 
edit_field_put_dhniaO(char  M^ork,  void  "'data), 
edit_field _get_dhinsl(cliar  *wotk,  void  'Mata), 
edit_fidd_put_dlinisl(char  "^vork,  void  'Mata), 
edit_field_key_dhnis(Edit_field_info  'Mifo,  int  key); 


'*  The  screen  callback  fiinctioas  take  these  argumoits; 

* 

"'  pre(Edit_screea  "Screen) 

*  post(Edit_screeo  "teraen) 

* 

*  The  screen  callback  functions  give  you  control  juA  before  the  screen  goes 

*  up,  and  just  after  it  conies  down.  The  primary  use  tor  these  callbacks  is  to 
*'  niodify  all  the  fidds  at  once,  specially  when  several  fidds  are  related. 

*  - */ 

typedef  struct  edit  screen 

{ 

int  label_count;  Edit_label  '*labds; 
int  field_count;  Edit_fidd  Melds; 

void  Mata; 


•dlt  rt.h 


•dlt  rt.h 


iot  chiaged; 

void  (*preX^nKt  _edit_flci«efi  ♦); 
void  (*pottXitnict  _edit_scfeen  *); 

struct  {  Edit_field  *ptr;  Edit_field_uifo  info;  }  cuncnt_field; 
}  Edit_screeo; 

/* - */ 

extern  void 

edit_screen_iniXEdit_screea  Screen), 
edit_screen_stop(void); 

extern  int 

edit_screen_k^_handler(Edit_scfeen  Hcraea,  int  key); 
#endif_EDIT_RT_ 


•dlt  rt.h 


*  Public  Doauun 

'*  Tbomas  J.  Silva  and  The  Telemetiy  W(»kahop,  Inc. 

* 

* - *! 

0if  !delined(_EMM J 
#define  _EMM_ 

#include  <types.h> 


Heie  aie  some  constants  /  enumerations  /  structures,  and  the  prototypes  of 

*  the  iow-levei  EMM  calls. 

*  - */ 

fdefine  EMM  INT  0x67 

ddefine  EMM  VER4  0x40 

Mefine  EMM  PAGE  SIZE  (16‘»1024) 

#define  EMM_PAGE_PARAS  (EMM_PAGE_SIZE/16) 

typedef  struct  {  ushort  seg,  page;  }  Emm_phys_map; 

typedef  struct  {  ushort  page,  phys;  }  Emm_map; 

enum  emm_phys_type  {  EMM_physj)age,  EMMj>hys_seginait  }; 


/• — 


*/ 


extern  int 

_emm_version(uahort  'Nersicm), 

_emm_pages(ushort  "total,  ushort  *free}, 

_emm_firame_seg(ushort  *seg), 

/*"  _emm_phys_pages(ushort  "pages),  */ 

/*  _emm_phys_maps(Emmj)hys_map  "tnaps,  ushc'.t  "pages),  *! 
_emm_aUoc(ushort  "handle,  ushort  pages), 

_emm_real]oc(ushort  handle,  ushort  pages), 

_emm_firee(ushort  handle), 

_emm_map(udiort  phys_page,  ushort  handle,  ushort  page), 
_aiun_iiu4>_multi(int  type,  ushort  handle,  ushort  count,  Emm_map  "maps), 
_emm_name_get(uahort  handle,  char  "name), 

_emm_name_set(uahort  handle,  char  "name), 

_emm_name_find(uahort  "liandle,  char  "name), 

_emm_handlej)ates(uahort  handle,  ushort  "pages); 


"  An  Emm_info  structure  holds  informatioi  about  the  EMM  qrstem.  You  should 
"  make  just  one  of  these  in  your  program. 


* 


The  element  .phys.pages  will  be  0  if  EMM  not  present,  is  an  old  version,  or 


*  Cult  in  some  other  manner  during  emm_infb_c(»structO. 

♦  ~ 

*  NOTES: 

* 

*  The  Emm_nian)ed  structure,  and  the  array  of  these  maps  in  the  Emm_info,  were 
**  fiom  an  earlier  version  of  this  code.  This  version  does  not  try  to  keep 

*  track  of  things  as  did  the  previous  version. 

* 

*  This  version’s  Emm_mfo  has  the  array  .map_0123,  which  you  can  use  to  »Mp 

*  the  first  four  pages  of  any  handle  into  the  four  pages  of  the  page-friune. 

*  -  - 

I* —  typedef  struct  {  struct  _emm_handle  *emm:  usbort  page;  }  Enun_mapped;  — */ 

typedef  struct 

{ 

ushort  pages_free,  pages_total; 

struct  {  ushort  pages,  segments[4];  }  fdiys; 

/* —  Emm_mapped  nupped[4];  — */ 
int  last_error; 

Emm_inap  mi4>_0123[4]; 

}  Enunjnfo; 

/* - */ 

extern  void 

emm_info_constiuct(Enim_iafo  "this); 
fdefine  emm_info_exists(this)  ((this)->|d)ys.pages  !=  0) 


"■  An  Emm_handle  structure  holds  information  about  one  EMM  handle.  Make  one 

*  of  these  for  every  EMM  allocation. 

*  - */ 

typedef  struct  emm  handle 

{ 

ushort  handle; 

Emm_info  "info; 
ushort  pages; 

/* —  ushort  pages_mapped;  — */ 

}  Emm_handle; 

/* - ♦/ 

extern  void 

eimn_construct_new(Emm_handle  *diis,  Emm_info  *info,  ushort  pages), 
eimn_oonstruct_known(Emm_handle  "this,  Emm_info  "^imn_info,  udiort  handle), 
emm_destro3r(Emm_haiidle  "this); 

fdefine  enun_exists(diis)  ((this)- >  handle  !»  0) 

fdefine  emm_name _^(this,name)  _emm_name_^get((this)->  handle,  name) 


idefine  eiiiin_iMiiie_iet(this,iuuiie)  _eiiiin_iuine_iet((this)->  handle,  name) 
extern  int 

einm_iiiap(Bnim_bandle  *tiiis,  uahort  physjMge,  uafaort  page), 
enun_aiap_miilti(Enim_liaDdle  "this,  int  Qrpe,  ushort  count,  Einm_map  ^maps); 


ieodif  EMM 


k«ys.h 


/*« 


0ifodef  KEYS 
iWefuie“KEYS" 


extern  int  key_liit(void); 
extern  int  key_get(void); 
extm  unsigned  int  key_flags(vok 


Mefine  KEY_flag_lshift  0x0002 
#define  KEY_flag  rshift  0x0001 
#define  KEY_fIagIshift  0x0003 


idefine  KEY_space  0x0020 
#define  KEY  esc 
#define  KEY_cr  OxOOOd 

#define  KEY  If  OxOOOe 

#define  KEY~bs  0x0008 

Mefine  KEY^del 

#define  KEY_tab 

#define  KEY_backtab  OxOIOf 

#define  KEY  fl  0x013b 

#define  KEY  f2  0x013c 

#define  KEY^O  0x013d 

Mefine  KEY~f4  0x013e 

Mefine  KEY~f5  0x013f 

#define  KEY_f6  0x0140 

#define  KEY  H  0x0141 

#define  KEY^fB  0x0142 

#define  KEY  19  0x0143 

Mefine  KEY_flO 

#define  KEY_shft_fl  0x0154 

Mefine  KEY  shft_f2  OxOlSS 

Mefine  KEY  shft  13  0x0156 

#define  KEY^shlt  j4  0x0157 

Mefine  KEY~shft_f5  0x0158 

#define  KEY~8hfi  16  0x0159 

Mefine  KEY~shft~n  OxOl5« 

#define  KEY  sbft~f8  0x015b 

Mefine  KEYlslift~f9  0x015c 

Mefine  KEY_shft~flO  0x015d 

Mefine  KEY  cnti  fl  0x015e 

Mefine  KEY  catl  f2  OxOlSf 

Mefine  KEY~cntrf3  0x0160 

Mefine  KEY~cntl  f4  0x0161 


OxOOlb 

0x0153 

0x0009 


0x0144 


keys.li 


k«ys.h 


«defiM  KEY  entl  f5  0x0162 

fdefine  KEY  cnU  fS  03^163 

Mefine  KEY~cnU~f7  0x0164 

Kdefine  KEY  cnti  18  0x016S 

Mefioe  KEY  cnU  19  0x0166 

idefioe  KEYicntllflO  0x0167 

fdefine  KEY  ait  fl  0x0168 

fdefine  KEY'alffZ  0x0169 

fdefine  KEY.alfo  0x016a 

fdefine  KEY_alt_f4  0x0 16b 

fdefine  KEY_alt_f5  0x016c 

fdefine  KEY  alt  16  0x016d 

fdefine  KEY'alff?  0x016e 

fdefine  KEY'alffg  0x016f 

fdefine  KEY'alt'lO  0x0170 

fdefine  KEYlalfflO  0x0171 

fdefine  KEY_right  0x014d 

fdefine  KEY_left  0x014b 

fdefine  KEY  up  0x0148 

fdefine  KEY~(k>wn  CxOlSO 

fdefine  KEY  home  0x0147 

fdefine  KEY~eod  0x014f 

fdefine  KEY_pgup  0x0149 

fdefine  KEY_pgdn  0x0151 

fdefine  KEY  cnti  right  0x0174 

fdefine  KEY~cnd left  0x0173 

fdefine  KEY_cntl_up  0x0 18d 

fdefine  KEY_cntl_down  0x0191 


fdefine  KEY_alt_r  0x0113 

fdefine  KEY  alt  s  0x01  If 

fdefine  KEY'alft  0x0114 

fdefine  KEY  alfw  0x0111 


fdefine  YES  1 
fdefine  NO  0 

)ltaidif_KEYS_ 


k«ys.h 


nps_if .h 


* - */ 

#ilhdef_NPS  IF 
Mefiiie  NFS  IF 


#iiicliide  <vector.h> 


extern  int 

nps_systein_iiiit(void), 

nps_key_handler(int), 

nps_display_iiiit(void); 

extent  void 

nps_^stein_stop(void), 

nps_data_fliish(void), 

aps_data_update(State_vector  '*'orb_ins_mSO, 
Quateraion  'N}rb_quat, 

State_vector  *orb_targ_in50, 
State_vector  *orb_gps_in50, 
State_vector  ''■orb_gps_ecef, 
State_vector  *spas_sv_ecef, 
State_vector  ■''spas_gps_ecef), 
nps_process_data(int  have_ofb_gps,  int  orb_pkt_type); 


#eiidif  NFS  IF 


orbnMChl.h 


* - ♦/ 

#ifiidef  _(»BMECH1_ 

Wefine  _ORBMECHl_ 

finclude  <coast.h> 

#include  <vector.h> 

typedef  struct 

{ 

double  planet_mu; 
double  planet_ndius; 
double  planet_oiiiega; 
double  planet_flattenii>g; 
double  plaiietJ2; 
double  cc[S30]; 
double  ss[S30]; 

}  Gnvity_data; 

typedef  struct 

{ 

int  mode; 

int  number_zonal; 

int  number_tesseial; 

Gnvity_chUa  GMD; 

}  Gravily_model_data; 

typedef  struct 

{ 

int  mode; 
double  8olar_flux; 
double  mean_solar_flux; 
double  geomagnetic_index_q>; 
double  balli8tic_number; 

}  Dnig_niodel_data; 


typedef  struct 

{ 

Gmvity_model_dsta  Gravity; 

Drag_model_data  Drag; 

}  Perturbations; 

/• - */ 

extern  int 

bgprop_init(void); 

extern  void 

bgprop_year(int  year). 


orbaMCbl .  h 


orkaMchl .  h 


bgprop((iouble  tiiiie_total,  Vector  *po8,  Vector  '*Vel,  Peiturbetions  *P, 
double  delta_t.  double  step.  Vector  *posf.  Vector  *velf), 
instantiate_so^t(int  nK>del_iuune,  Perturbations  *P), 
in50_wgs84_inS0(State_vector  *svui,  State_vector  *svout, 

int  direction,  State_vector_transform  *svt,  int  vel_is_ecef); 

iHendif  ORBMECHl 


orbnechl.h 


p«ek«t.h 


♦ - */ 

Mfiidef  PACKET 
Mefiiie  _PACKET_ 

#include  <vector.h> 


*  The  packet  start  sync  is  EB  90,  the  stop  ^c  is  BE  EF.  The  type  is  two 

*  ttytes  instead  of  one  to  insure  even-byte  alignment  for  the  remaining  parts  of 

*  the  structure. 

*  - */ 

typedef  struct 

{ 

ubyte  tync_start[2]; 
int  type; 

}  Packet_header; 

typedef  struct  {  ubyte  aync_stop[2];  }  Packet_trailer; 

eoum  packet_types  {  PKT_orbiter  =  1,  PKT_spas,  PKT _gps  }; 


*  These  packets  are  meant  to  go  from  one  PC  to  another.  The  receiving  PC 

*  program  may  not  know  where  the  data  comes  from,  nor  should  it  have  to  know. 

* 

*  Therefore  the  sending  machine,  regardless  of  its  architecture,  must  build 
the  packets  with  this  format: 

All  multi-byte  elements  are  in  Intel  order:  LSB  first  (little-endian). 

*  Doubles  are  IEEE  format. 

* 

*  In  addition,  the  data  must  be  converted  in  this  manner: 

Hmes  are  floating-point  seconds  of  GMT,  note  that  001/00:00:01.000 

*  (1  sec  past  nudni^t  on  Jan  1st)  is  1  sec  -t-  86400  (1  day). 

Angles  are  in  degrees. 

Orbiter  state  vectors  are  MSO,  in  ft  and  ft/s. 

'*  Spas  state  vectors  are  WGS84,  in  ft  and  ft/s. 

* 

Note:  packet  type  3  (PKT jgps)  is  used  only  for  testing. 

* - */ 

typedef  struct 

{ 

double  range,  roll_azimuth,  pitch_elevation,  range_rate; 
ushort  range_good,  angles_good,  rate_^ood; 

}  Ku_info; 

typedef  struct 


pack«t.h 


packet. b 


{ 

P>icket_header  heado-; 

State_vectc»’  orbiter_vector; 
Quatenuoa  orbiter_quat; 

Ku_info  ku; 

State_vector  terget_veclor; 
I^cket_tndler  trailer; 

}  OrbjMcket; 

typedef  struct 

{ 

FBcket_header  header; 

State_vector  spas_vector,  gps_vector; 
Packet_trailer  trailer; 

}  Spas_packet; 

typedef  struct 

{ 

Packet_beader  header; 

State_vector  gps_vector; 
Packet_trailer  trailer; 

}  Orb_gps_packet; 

#endif_PACKET_ 


packet.b 


• - */ 

#ifiidef  PKT  IF 
idefiiie  _PICr_IF~ 

#iiiclude  <vector.h> 


extern  void 

orb_port_packet_check(int  on_off); 
extern  int 

orb_port_init(void), 
orb_j>ort_init_bynaine(chJU'  ’'filename), 
orbjx>rt_stop(void), 
oibjport_getb(void), 

orb_poit_read(iiiuigned  char  *whae,  int  bytes), 
orbjx>rtj>rocess(void); 

extern  int 

taiis_port_init(void), 

tans_port_init_bynaine(char  ’Rename), 

tansjx>rt_stop(void), 

tans_port_jetb(void), 

tan8_poit_sendb(unsigned  char  value), 

tans_port_read(unsigned  char  'Svbm,  int  bytes), 

tans_port_process(void); 


#eodif  PKT  IF 


awmp.h 


/' 


#if  IdefuwdCSWAPJ 
#defuie  _SWAP_ 


A 

extmi  void  swap_double(void  *to,  void  *firom); 
extern  double  swap_doubIe_out(void  ^from); 

extern  void  swap_float(void  '*to,  void  <*11001); 
extern  float  twap_float  out(void  <*1100): 

extern  void  swap_short(void  *to,  void  ^from); 
extern  ushort  swap_short_out(void  '''from); 

#endif_SWAP_ 


■*! 


■*! 


swap.h 


tansjpkt.h 


/*« 


• - *! 

#ifndef  TANS  PKT 
Mefine  _TANS_PKT_ 

fmclude  <vflcu>r.h> 


* - */ 

typedef  stnict  {  float  x,  y,  z;  }  Vector_float; 

typedef  struct  {  ubyte  die,  type;  }  T«iis_pkt_head; 
typedef  struct  {  ubyte  die,  etx;  }  Tsiis_pkt_Uil: 

/* - *! 


typedef  struct 

{ 

float  secs_of_wedc; 
mt  week; 

float  nM_utc_ofRset; 

}  Tan8_pkt_21_41; 

/* - */ 

typedef  struct 

{ 

ubyte  dyn.code; 

float  elev_angle_inask,  sigiialjvl_inask,  pdop^inask,  pdop_switcb; 

)  Taiis_pkt_2c_4c; 

/* - */ 

typedef  struct  {  ubyte  position,  velocity,  timing,  auxiliaiy;  }  Tans_pkt_3S_55; 

/• - */ 

typedef  struct  {  Vector_float  vel;  float  gigo;  float  sol_time;  }  Tans_pkt_43; 

typedef  struct  {  Vector  pos;  double  gigo;  float  8ol_tiii)e;  }  Tans_pkt_83; 

t* - */ 

typedef  struct  {  ultyte  satellite;  }  Taiis_pkt_3c; 

typedef  struct 

{ 

ultyte  sat_pm,  slot_code,  acq_flag,  epiiem_flag; 

float  signal_level,  tune,  elevation,  azimuth; 

ubyte  old_meas,  maec_flag,  data_bad_flag,  data_coIlect_flag; 

}  Tans_pkt_5c; 

/♦ - */ 


tans^pkt.h 


t«n«_pkt.h 


typedef  itnict 

{ 

ut^  coatrol,  ut_select,  c«iTier_tnck,  difr_tnck; 
}  T«itf_pkt_eat_el; 


/* - *! 

typedef  stniet  {  ubyte  snr;  int  difjihaae;  }  Tant_pkt_e4_sfaive; 

typedef  stnict 

{ 

ulqrte  sIot_code,  ttt_pni; 
int  meu_count; 
ubyte  mr; 

fleet  code_phese,  doppler; 
double  time; 
ulong  caiTier_beet; 
ubyte  master_index; 

Tens_pkt_e4_sleve  sleve_ent[3]; 

}  Tensj)kt_^; 


• - •/ 

#define  TANS  PKT  SIZE  RAW  512 
Meflne  TANS_PKT_SIZE_COOICED  256 

typedef  eaum 

( 

TANS_itele_fuid_8tert,  TANS_itete_hed _gigo,  TANS  state  pedeet  eteit. 
TANS_itate_find_eiid,  TANS_itate_found_dle,  TANS  state  packet  bad. 
TANS  itate  pacto  ok.  TANS_state_over8i» 

}  Tans_p^et_state; 

typedef  stfuct 

{ 

ulyte  i*wrrANS_PKT_SIZE_RAW],  cooked(TANS_PKT_SIZE_COOKED]; 
int  niw_si2e,  codced_si2e,  state; 

}  TansjM^et; 

/* - */ 

extern  int 

tanajpacket_iecv(Tans_packet  ^packet); 

#endif_TANS_PKT_ 


t«ns_pkt.h 


tlMC.h 


*  Public  Domain 

*  Thomaa  J.  Siva  and  buoe  G.  Jackaon  A  Aaaociates,  Inc. 

* 

* - */ 

#if  !defined(_TIMESJ 
dUefine  HMES 


* - •/ 

typedef  atnict  {  unsigned  abort  days,  hours,  mins,  secs,  msecs;  }  llme_dhm8; 

typedef  struct  {  int  week;  double  secs;  }  Time_gps; 

typedef  struct  {  int  year;  double  secs;  }  *nnie_utc; 


*  WARNING:  Theae  routines  are  not  coded  to  handle  negative  time! 

* 

*  The  string  routines  make  this  fixed  size  string:  *ddd:hh:nun:ss.I23*,  and 

*  need  18  bytes  with  whidi  to  work,  so  size  your  work  area  accordingly. 

*  - */ 

extern  char 

etiine_dhins_to_strmg(Tinie_dhins  *dhms,  char  ^oik), 
*time_dbl_to_atrmg(doubIe  *taac,  char  '^vork); 

extern  void 

time_dbl_to_dhms(double  *time,  Time_dhms  ’Mhnis), 
time_dhms_to_dblCIime_dhms  "dhins,  double  "time), 
tinie_^_to_utc(Time _gps  *gps,  double  a;>s_leada_otc,  'nme_utc  *utc); 

extern  void 

rtc_timer_aet(unsigned  short  niaec_count,  void  *flag); 
llbodif_TIMES_ 


tlMS.inc 


Stnolut 


;  *  Public  Dmuun 

;  *  Tbomu  J.  Silva  and  Brace  G.  Jackson  &  Associates,  loc. 

.  * 


strac  time_sec_insec 

secs  dd  7 

msecs  dw  ? 

ends 

strac  time_sec_nsec 

secs  dd  ? 

nsecs  dd  ? 

ends 

strac  time^dhms 

days  dw  ? 

hours  dw  ? 

mina  dw  ? 

secs  dw  ? 

msecs  dw  ? 

ends 

«iist 


tlBMS  .  Inc 


typM.h 


typedef  unsigned  long  ulong; 

typedef  unsigned  short  ushort; 

typedef  unsigned  char  ubyte; 

lypedef  duu  byte; 

Mefine  YES  1 
fdefine  NO  0 

#if  !defined(FP_OFF) 

ii'define  MK_F^seg,off)  ((void  ftr  *K((ulongKseg)  <  <  16)  |  (ushortXoff))) 
#eodif 

iendif_TYPES_ 


typ«s.h 


vector. h 


/* 

* 

iKfbdef  VECTOR 
jMefine  _VECT(»_ 

jKnciude  <types.h> 


*/ 


'*  I  deflne  the  quatemion  rotation  as  follows:  positive  twitt  is  counter- 

*  clockwise  when  looking  down  the  rotation  vector  towards  the  origin.  This  is 

*  consistent  with  a  right-hand  rotation  where  the  thumb  points  out  along  the 
rotation  vector.  This  is  also  the  way  the  books  describe  it. 

e 

NASA  apparently  defines  positive  rotation  clockwise,  thus  all  names  and 
labels  are  "backwards''  when  used  with  diis  code.  For  example:  "M50  to  Body* 
must  be  treated  as  a  "Body  to  M50*  rotation.  However,  just  to  confuse  us, 
the  names  used  by  the  onboard  software  appear  to  be  correct:  the  onboard  name 

'*  *Q_Br  corresponds  to  the  ground  name  "M50  to  body".  Go  figure. 

* 

*  The  physical  layout  of  the  quatemion  structure  corresponds  to  the  Q1-Q4 

*  as  used  by  NASA:  Q1  is  the  scalar,  Q2  is  the  x  component,  etc. 


♦ - */ 

typedef  struct  {  double  x,  y,  z;  }  Vector; 

typedef  struct  {  double  s,  x,  y,  z,  time;  }  Quaternion; 

typedef  struct  {  Vector  pos,  vel;  double  time;  }  State_vector; 

typedef  struct  {  Vector  pos;  double  time;  }  RV_vector; 

//  typedef  struct  {  double  roll,  pitch,  yaw;  }  Euler_angles; 

typedef  struct  {  double  low,  hi;  }  Vector_limits; 

typedef  struct  {  Vector_limits  pos,  vel;  }  State_vector_limits; 

/* - */ 

extern  double 

vector_magnitude(Vector  '►v), 
vector_dot(Vector  *vl.  Vector  *v2); 

extern  void 


vector_diff(Vector  '►vl.  Vector  *v2.  Vector  •vout), 

vector_add(Vector  *vl.  Vector  *v2.  Vector  ♦vout), 

vector_cron(Vector  "Vl,  Vector  *v2.  Vector  "Vout), 

vector_transfomi(Vector  *vin.  Vector  "Vout,  double  transfonD[3][3]), 

vector_rvbar(State_vector  *tafg^,  State_vector  *chaser.  Vector  *rv.  Vector  'tyvdot), 

matrix_transpose(double  matrix_in[3][3],  double  matrix_out[3][3]), 

//  matrix_pyr(double  m[3][3],  Euler_angles  '*euler). 


vector. h 


vector. h 


qiMteniioD_coBjug«te(QiiateniiaD  *q), 
quateniion_to_iiiatrix(Quatemioa  double  iiiatrix[3][3]). 
quateniioo_mult(QuatMnjoa  *ql,  Quatenum  *q2,  Quatemioo  *qout), 
//  quatemioojfiyrCQuatenuon  Eul«‘_angles  *tuler), 
quateniioii_iiomiali2ie(QuatemioQ  *q); 

extern  int 

vector_unit(Vector  •vin.  Vector  *vout), 
vector_clieck(Vector  *v,  Vector_limits  *liniit). 
matrix_to_quatemioa(double  nHtrix[3][3],  Quaternion  *q), 
8tate_vector_itol_niatrix(State_vector  *8v,  double  niatrix[3][3]), 
atate_vector_cbeck(State_vector  *v,  State_vector_limits  ^limit); 


/♦s 


This  structure  is  used  to  transform  one  state  vector  into  another.  Some 

*  transformations  need  a  time  stamp  on  the  matrix. 

*  - */ 

typedef  struct  {  double  matrix[3][3],  time;  }  State_vector_transform; 

/* - */ 

extern  void 

state_vector _ rotate_mSO_ecef(State_vector_transform  '*1nS0_ecef, 

double  new_time, 

State_vector_transfonn  '*ecef_niSO), 
state_vector_m50_to_ecef(State_vector  *0150,  State_vector  ♦ecef, 

State_vector_trBnsform  *m50_ecef_epoch,  int  vel_is_ecef), 
state_vector_ecef_to_m50(State_vector  *ecef,  State_vector  *mW, 

State_vector_transform  ♦m50_ecef_epoch,  int  vel_is_eceO, 
state_vector_m50_toJ2000(State_vector  *m50,  State_vector  ^2000), 
state_vector _ i2000_to_in50(State_vector  "52000,  Stide_vector  "taSO); 

iKeodif_VECTOR_ 


vector. h 


con  txrx.c 


s  s  s  s  « 

iKnclude  <stdio.h> 

#include  <alloc.h> 
finclude  <coiiio.h> 

#iiiclude  <edit.h> 

#uiclude  <keys.h> 
finclude  <comj)ort.h> 

_ ^  . -  - . 

static  int  poitjd,  packet_size; 

static  struct 

{ 

int  in_use,  yline,  next; 
ubyte  '''packet; 
ushoit  cnt; 

}  tx.  rx; 

#define  INFO_X  5 


static  int 
init(void), 
recv_next(void), 
recv_chk(void); 

static  void 

send_next(void), 

recv_dunqj(void); 


*/ 


*/ 


iiiain(int  argc,  char  '"'''argv) 

{ 

static  char  msgQ  s 
•\nTest  keys:\n” 

*  t  Toggles  packet  sradNn” 
'  r  Toggles  packet  recv\n” 

*  ESC  Stop  the  test\n" 

•Nn" 

"  TX\n' 

"  RX\n" 


con  txrx.c 


aam_txrx.c 

"Both  rx  and  tx  are  now  off.  Hit  any  key  to  begin  transfer  test"; 

*/ 

if  (initO  *  ■■  NO)  return; 

puts(msg);  key_getO; 
gotoxy(l,  who^O'O:  clreolO; 
tx.yline  »  (rx.yline  ■  whereyO  - 1)  -  1; 

for  (;;) 

{ 

if  (key  hitO) 

{ 

ushort  key  «  key  jetQ; 

if  (key  ■  « ’t’)  U.in_use  *  (tx.in_U8e  ?  NO  :  YES); 

else  if  (key  «  *  ’r’)  rx.in_use  «  (rx.in_u8e  ?  NO  :  YES); 
else  if  ^ey  »  «  KEY  esc)  break; 

} 

if  (tx.in_use)  send_nextO: 

if  (rx.in_u8e  SiJSl  recv_nextO  ^  *  NO)  break; 


coni_poit_8top(port_|i  % 


static  int  initQ 

{ 

ushort  rx_size,  tx_size; 

long  baud; 

int  parity,  stops; 

*! 

poit_id  «  edit_integer(”Enter  port  id  ”,  1); 
rx_size  >■  edit_integer(”Enter  rx  buffer  size  ”,  S12); 
tx_size  K  edit_integer(”Eoter  tx  buffer  size  ”,  S12); 

if  (comjport  staft(port  id,  rx  size,  tx  size)  » «  NO) 

{ 

printf(”Can’t  start  port  %d\n”,  portjd); 
port_id  “  0; 
return  NO; 

) 


/*- 


com  txrx.c 


COB  txrx.c 


baud  »  edit_integer_long(*Enter  baud  late  *,  9600); 

parity  s  edit_integer(*Enter  parity  (0  none,  1  even,  2  odd)  ”,  2); 
parity  “  (parity  *»  0 
7  COM_P(»Tjiar_none 
:  (parity  1 
?  COM  PORT_par  even 
:  COM_PORT_par_odd)); 

stops  3s  edit_integer( 'Enter  stop  bits,  1  or  2  ”,  1); 

stops  —  (stops  1  7  COM_PORT_stop_l  :  COM_PORT_stop_2); 

com_poit_set(port_id,  baud,  parity,  stops); 
comjx)rt_get(port_id); 

/* - 

*/ 

packet_8ize  =  edit_integer(”Enter  packet  size  ”,  32); 
if  (packet_size  <  4)  packet_size  —  4; 

tx.packet  »  nudloc(packet_size);  rx.packet  —  nudloc(packet_size); 
if  (tx.packet  =  =  NULL  1 1  rx.packet  =  =  NULL) 

{ 

coni_port_8top(port_id); 
return  NO; 

} 

else 

{ 

int  cnt; 

meaiset(tx.packet,  0,  packet_8ize); 
tx.packet[0]  s  Oxde;  tx.packet[l]  »  Oxad;  //  dead 

tx.packet[2]  »  Oxbe;  tx.packet[3]  =  Oxef;  //  beef 

for  (cnt  =  4;  cnt  <  packet_8ize;  cnt+  +) 
tx.packet[cnt]  =  (ubyte)cnt; 

} 

return  YES; 

} 


* - - - */ 

static  void  send  nextQ 

{ 

if  (com_port_put(port  id,  tx.packet[tx.next])  =  =  YES) 

{ 

if  (+  -t-tx.next  >  *«  packet  size) 

{ 

gotoxy(INFO_X,  tx.yline);  cprintf('%5u”,  tx.cnt++); 
tx.next  s  0; 


com  txrx.c 


} 


} 


} 


l*m  ssBsssBSBSKacacBsmsKBBSBatatatSKBVKBB 


* - •/ 

■tadc  int  racv  nextQ 

{ 

iot  value; 

if  ((value  *  com_port_jet(port  id))  !■  -1) 

{ 

rx.packet[rx.next]  »  (ubyte)value: 
if  (-f+rx.next  >«  packet  size) 

{ 

if  (recv_chkO  =  *  NO) 

{ 

printfCXiirx  Xu  Ailed:*,  rx.ait); 

recv_duiiipO; 

retuni  NO; 

} 

gotoxy(INFO_X,  rx.yline);  cprintf(**5u",  rx.cnt++); 
rx.next  -  0; 

} 

} 

letura  YES; 

} 


* - */ 

static  int  recv  chkQ 

{ 

int  cnt; 

if  (rx.packet[0]  !»  Oxde  1 1  rx.packet[l]  !»  Oxad 
1 1  fx.packet[2]  !»  Oxbe  1 1  rx.packet[3]  Oxef)  return  NO; 

for  (cnt  as  4;  cnt  <  packet_size;  cnt+  4-) 

if  (rx.packet[cnt]  (ul^)cnt)  return  NO; 

return  YES; 

} 

static  void  recv  dunqK) 

{ 


int  cnt; 

for  (cnt  as  0;  cnt  <  packet_8ize;  cnt+  +) 


com  txrx.c 


earn  txrx.c 


( 

if  ((cot  *  16)  0)  priDtf(*\ii  *04x  *,  cnt); 

printfC  %02x”,  rx.piick^cnt]): 

} 

^Hite(’\n',  stdout); 


conn  txrx.c 


tMt.C 


*/ 

iKBclude  <stdio.h> 
jKnclude  <stdlib.h> 
iKncIude  <iiiein.h> 
finclude  <atring.h> 


iMncliMle  <eiiun.b> 


'*  These  structures  are  global  because,  well,  they  need  to  be! 
*1 


Emmjnfo  emin_info; 
Emin_handle  emm_handle; 


♦ _ _ _ */ 

inain(int  argc,  char  '*"*'argv) 

{ 

static  char  ^errsQ  s 

{ 

"EMM  ok", 

"EMM  init  Adled,  error  %d\n", 

"EMM  handle  fiuled,  error  %d\n", 

"EMM  map  failed,  error  %d\n", 

"Usage:  einm_name  [pages]\n" 

}; 

int  rc; 

/*. - 

Go  ahead,  mrice  my  mem! 

*/ 

if  (argc  <  2}  {  puts(eiTs[4]);  return;  } 
rc  s  make_my_emm(argv[l],  atgv[2]); 
if  (rc  !—  0)  {  printf(errs[rc],  emm_info.la8t_error);  return;  } 

/• - 

*/ 

printf("EMM  handle  %d  <  5(s>  has  %d  pages,  and  is  mapped  at  %04x\n", 
emm_baad]e.haodle,  aigv[l],  mnm_handle.pages,  emm_info.pbys.s^gments[0]); 

if  (yes  no("Delete  this  handle  ?"))  emm  destroy(&emm  handle); 


tMt.C 


tMt.C 


*  returns: 

*  0  ok 

*  1  Can’t  find  EMM  on  this  nuuhine 

*  2  Can’t  create  memoiy  handle 

*  3  Can’t  map  the  memory  into  physical  page  0 

*  - */ 

make  my  e0un(char  '*raw  name,  char  ^makejiages) 

char  aame[9]: 
ushort  pages,  handle; 

/* - 

*  Fill  in  the  emm  info  structure,  make  sure  EMM  exists  on  this  machine. 

•/ 

emm_info_construct(&emm_info); 

if  (!  emm_info_exists(&emm_info))  return  1 ; 

/* - 

Look  for  an  existing  named  memory  chunk.  If  it  doesn’t  exist  then  make 
a  new  chunk  of  size  1  (16IC),  and  give  it  a  name. 

*/ 

memset(name,  0,  sizeof(naine)); 

8tmcpy(name,  riw_name,  8); 

if  (_emm  name  findf&handle,  name)  !  =  0) 

{ 

if  ((P^ges  —  atoi(make_pages))  >  emm_info.pages_fTee) 
pages  s  emm_info.pages_free; 
emm_construct_new(&emm_handle,  &emm_info,  pages); 
if  (emm  exists(&emm  handle))  emm  name  setf&enun  handle,  name); 

} 

else  emm_construct_koown(&emm_handle,  &emm_info,  handle); 
if  (!  emm_exists(&emffl_handle))  return  2; 

/♦ - 

*  Map  the  memoiy  somewhere  (use  the  first  physical  page,  page  0). 

•/ 

if  (emm_inap(&emm_handle,  0,  0) !  s  O)  return  3; 
return  0; 

} 


* _ */ 

yes_no(char  *pronq>t) 


mam  tmat,c 


tMt.C 


{ 

cliir  aiit(80]; 

fputtOMonpt.  itdout); 
aiit(0]  -  0;  ■caiif(’%t*.  •■»): 

retum  (aiis[0]  «■  ’y’  1 1  anip)]  ■■  ’Y’); 

} 


t«8t.C 


iKnclude  <itdio.h> 
iKncliide  <itdlib.h> 
iKncIude  <coiuo.h> 


♦ - ♦/ 

int  main(int  wgc,  char  **MTgv) 

{ 

sUtfk  char 

msglQ  «  'Usage:  %a  niap_text  map_raw\n*. 
insg2Q  s  "Can’t  open  file  <%s>\ii*: 

FILE  *in,  *out; 


♦/ 

if(argc  <  3) 

{ 

pfintf(tnsgl,  aigv[0]); 
letum; 

} 

if  ((in  =  fopen(argv(l],  'rt'))  ==  NULL) 

{ 

printf<insg2,  aigv[l]); 
return; 

} 

if  ((out  *  fopen(argv[2],  *wb"))  « =  NULL) 

{ 

printf(msg2,  afgv[2]); 
return; 

> 

/* - 

*/ 

for  (;;) 

{ 

struct  {  unsigned  char  cmd;  float  longitude,  latitude;  }  point; 
int  rc; 

rc  B  ftcanf(in,  ”%d  %f  %r,  d^int.cnid,  Apoutlongitude,  &point.latitude); 
if  (rc  <  3)  break; 

Nmte(&point,  sizeof(point),  1,  out); 

} 

} 
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*  1  cImb  OHt  pickati  froin  a  (ik.  I  fiber  peckele  whoee  tunee  are  too 

*  ckiie  or  too  fiv  afMit. 

*  Uiafe:  pkt  file  is  file  out  pkt  type  dt  It  dtj|t 

*  - 1 — I - 1 - 1 - 1 - •/ 

iRacliide  <aldio.h> 
finclude  <atdlib.h> 

fbclude  <pecket.li> 
finclude  <k^.h> 
finclude  <pkt_if.h> 


*  Theae  etructurea  are  owned  Ity  the  ofb_port_proceaaO  routine,  and  are  in 

*  tbe  original  unita:  orbiter  vectora  are  MSO  in  ft  and  ft/a,  apaa  vectora  are 

*  WGS84  in  ft  and  ft/a. 

* 

*  The  orbiter  time  ia  abaolute,  001/00:00:01.000  1.0  aec  -f  86400  aeca  (one 

*  day).  The  apaa  time  ia  alao  abaolute. 

*  - */ 

extern  OrbjMcket  orbiter jMcket; 

extern  Spaa_paeket  apaajMcket; 


/♦* 


*  Thia  atructure  ia  alao  owned  by  die  orb_port_proceaa0  routine,  and  ia  only 

*  uaed  for  teating.  The  vector  ia  WGS84  in  m  and  m/a.  Ita  time  ia  abaolute. 

*  - •/ 

extern  Orb _gpa_packet  orbiter _gpa_padtet; 


/♦» 


* - *f 

atadc  FILE  *file_rx,  *file_tx; 
atatic  double  dt_lt,  dt jgt; 

atidic  char  uaageO  ” 

”Uaage:  Xa  pkt_file_ui  file_out  pkt_type  dt_lt  dt_gt\n* 

*  file_in  Input  file  with  pricket^” 

*  file_out  Output  file  for  filtered  packetaVn” 

*  pkt_type  Fadtet  type  to  filterVn* 

*  dt_lt  Throw  out  packeta  <  dtJtVn” 

”  dt_jt  Throw  out  packeta  >  dt _gt\n*; 

#define  BUFFER  SIZE  0x7000 


*  The  uTty  follows  the  pscket_types  eaumentioo. 

•  - 1 - */ 

typedef  stnict  {  int  tot_ooe,  size;  void  ^packet;  double  time.  *iiew_tiiiK;  }  Tuiie_iiifo; 

static  Hme  info  time  infosQ  » 

{ 

(0}. 

{  NO,  sizeof(Orb jpadcet),  &orbiter_padcet,  0.0,  &ofbiterj>acket.ofbiter_vector.time  }, 

{  NO,  sizeoflt^iasjMcket),  Aapasjpacket,  0.0,  &apas_packet.spas_vector.time  }, 

{  NO,  si2ieof(Orb  gps  packet),  diorbiter _gpa_pocket,  0.0,  dcorbiter _jpsj)acket.gps_vector.time  } 

}; 


/*=: 


* - */ 

inain(int  argc,  char  *'*at:gv) 

{ 

int  filter_type,  type; 

/■* - 

*/ 

if  (argc  <  6)  {  printf(uaage,  aigv[0]);  return;  } 

if  ((file  rx  *  fopen(argv[l],  *rb*))  =  **  NULL) 

{ 

printf("Can’t  open  file  <%s>\n*,  argv[l]); 
return; 

} 

setvbuf(file_rx,  NULL,  JOFBF,  BUFFER_S1ZE); 

if  ((file_tx  =  fopen(aigv[2],  "wb’))  »»  NULL) 

{ 

printf(*Can't  open  file  <%s>\n”,  argv[2]); 
return; 

} 

aetvbuf(file_tx,  NULL,  JOFBF,  BUFFER_SIZE); 

filter_type  *  atoi(atgv[3]); 
dtjt  »  atof(argv[4]); 
dt_gt  «  atofiargy[5]); 

/* - 

*/ 

while  ((type  *  orb j)ort_proces80)  >  0  Sc&  type  <  =  PKT _gps) 

{ 

'nme_info  *info  »  tiine_infos  +  type; 
if  (type  «  *  fiiter_type) 


{ 


if  (iiifo->got  one) 

{ 

if  (*iiifo->iiew_tiiiie  <  info-Xime  +  dt_lt 
1 1  *iiifo->iiew  time  >  info*>tiiDe  dt _gt)  continue; 

} 

else  info->ggt_one  «  YES; 
info->time  ''4nfo->new  time; 

} 

^vrite(info-> packet,  info->fi2e,l,  file  tx); 

} 

fcIose(fUe_rx); 

fclose(file_tx); 


int  orbjx>rt_getbO  {  return  getc(file_rx);  } 


pkt_ahoif.c 


*  1  show  packets  ftom  a  file. 

*  Usage:  pkl_fite 

*  - 1 - *! 

ifinclude  <^o.h> 
fiiicliide  <atdlib.h> 

iKnclude  <packet.h> 
iKiiclude  <keys.h> 

#inclu(fe  <{rict_if.h> 


These  structures  are  owned  by  the  orb_port_processO  routine,  and  are  in 
the  original  units:  orbiter  vectors  are  MSO  in  ft  and  ft/s,  spas  vectors  are 

*  WGS84  in  ft  and  ft/s. 

The  orbiter  time  is  absolute,  001/00:00:01.000  =  1.0  sec  +  86400  secs  (one 

day).  The  spas  time  is  also  absolute. 

*  - */ 

extern  Orbjtacket  orbiterjjacket; 

extern  Spas_packet  spasjpacket; 


*  This  structure  is  also  owned  the  oTb_port_process0  routine,  and  is  only 

*  used  for  testing.  The  vector  is  WGS84  in  m  and  m/s.  Its  time  is  absolute. 

*  - */ 

extern  Orb _gps_packet  orbiter_s>sjiacket; 

extern  int  orb_port_j)kt_error; 


* - ♦/ 

static  FILE  *file_rx; 

static  char  usageQ  =  "Usage:  %s  |;d(t_file\n''; 

#define  BUFFER_SIZE  0x7000 
static  void 

dump_packet(mt  type), 
dump_vector(State_vector  char  *m8g); 


plct_show.c 


pkt_«hoir.e 


* - */ 

miiiKbt  arfc,  chir  *’*argv) 

{ 

in*  type; 

/* - 

*1 

if  (argc  <  2)  {  printf(iiMige,  argv[0]);  letura;  } 

if  ((file  rx  -  fopea(aixv[l].  "rb"))  NULL) 

{ 

printf(*CaD't  open  file  <%s>\n‘',  ergv[l]); 
return; 

} 

ietvbuf(file_rx.  NULL,  JOFBF,  BUFFER_SIZE); 
orb_portjMcket_check(NO); 

/♦ - 

*1 

while  ((type  =  orb jportjirocessO)  >  0  &&  type  <  =  PKT _gps) 

{ 

dump_pecket(type); 

} 

fclose(file  rx); 

} 


e - *f 

int  orb_port _getbO  {  return  getc(file_rx);  } 


*  -  — 

ifinclude  <tinies.h> 
iRnclude  <conft.h> 


■*/ 


Mefine  POS  LOW_FT  21000000.0 
#define  POSIhI  FT  23000000.0 
Mefine  VEL  LOW  FT  10000.0 
Idefine  VEL_HI_Ff  40000.0 

iMefine  POS  LOW  M  (POS  LOW_FT  *  FT  TO  M) 
Mefine  POs”hI_m”  (POS  in_FT  ♦  FT  TO  M)  " 
#define  VEL_LOW_M  (vIl  LOW  FT  •  FT  TO  M) 
jfdefine  VEL_HI_M  (VEL_1B_FT  •  FT_TO_M) 

static  State_vector_iiniits 


pkt_aliow.  c 
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»  {  {  POS  LOW  FT.  POS  H1_FT  }.  {  VEL_LOW_FT.  VEL_H1_FT  }  }. 
limiLm  »  {  {  POS_LOW_M.  POS_HI_M  }.  {  VEL_LOW_M.  VEL_HI_M  }  }; 

static  void  dump  vector(State  vector  *sv,  char  '*1iisg) 

{ 

char  work[32]; 
int  pos_cric,  vel_ok; 

pos_ok  =  vector_check(&sv- >  pos,  ddiinit_ft.pos); 
vel_ok  s  vector_check(&sv->vel,  &liinit_ft.vel); 

time_dbl_to_string(&sv-  >  time,  work); 
iprintf(stderr,  "%-6s  msg,  work); 

fprintf(stderr,'\tpos  569  Of  569.0f  569.0r,  sv->pos.x,  sv->pos.y.  sv->pos.z); 
if  (p')s_ok  ==  NO)  tputs(*  ERR*,  stderr); 
fputc(’^’,  stderr); 

fpriiitf(stderr,*\tvel  569.0f  569.0f  569.0r,  sv->vel.x,  sv->vcl.y,  sv->ve!.z;; 
if  (vel_ok  ==  NO)  fputs(*  ERR*,  stderr); 
fputc(’\n’,  stderr); 


static  void  dumpjMcketfint  type) 

{ 

switch  (type) 

{ 

case  PKT_orbiter: 

dun^>_vector(&orbiter_packet.orbiter_vector,  *Oib*); 
duiiq»_vector(&orbiter_packet.  target_vector,  *Tgt*); 
break; 

case  PKT_spas: 

duiiq}_vector(&spas_packet.gps_vector,  *Spas”); 
break; 

case  PKT _gps: 
break; 

default:  break; 

} 


pkt_show.c 


tMsxm  v2.c 


/*> 


♦/ 

jKncIude  <ftdio.h> 
iKiMlude  <8(dlib.h> 

finclude  <k^s.h> 
iKnclude  <packet.h> 
^include  <frict_if.b> 
fKnclude  <Uns_pkt.h> 
#include  <tiiDes.h> 
il^ciude  <const.b> 


♦ - */ 

Orb_gps_packet  orbiter _^jMcket; 

static  int  my_tenniiiate  =  NO; 

static  FILE 

static  int  niy_file_done  =  NO; 


* _ _______ 

static  void 

do_file(cbar  *name), 

*  - 

int  tansjjort _^etbO 

{ 

int  rc; 

if  ((rc  =  fgetc(my_file)) 
return  rc; 

} 


■*/ 


■*/ 


EOF)  iny_file_done  =  YES; 


* - */ 

niain(int  aigc,  char  '""^gv) 

{ 

static  cbar  msgO  = 

"NnThese  keys  active  during  prognun:\n'' 

”  ESC  stops  prograni\n" 


tana  v2.c 


tmnm  v2.c 


any  key  to  begin"; 

/* - 

*1 

if  (argc  <  2) 

{ 

printf(*Usage:  5(s  tans-filel  ...  tans-fileN\n*,  argv[0]); 
return; 

} 

puts(msg);  key_getO; 

for(argv+  +  ;  argc  >  1;  argv+  +  ,  argc-) 

{ 

do_file(*argv); 

if  (my  terminate)  break; 

} 

} 


Mefine  M_TO_KILOFT  (M_TO_FT/ 1000.0) 


static  void  do  fUe(char  *aaiBe) 

{ 

if  ((my  file  =  fopen(nanie,  *rb"))  =  =  NULL) 

{ 

printf(*Can’t  open  file  <%s>\n",  name); 
return; 

} 

printf("File  <56s>\n",  name); 
my_file_donc  =  NO; 

/♦ - - 

*! 

for  (;;) 

{ 

char  work[24]; 

/* - 

*/ 

if  (key_hit0)  main_keyjprocessO; 
if  (my_terminate  1 1  my_file_done)  break; 

/* - : - 

*/ 

tans  v2 . c 


tans  v2.c 


if  (tans_poTt_processO  *  *  NO)  cootinue; 

tiine_dbl_to_striiig(&orbiter_g)s_packet.gps_vector.tinie,  work); 
printft’lTine  %c\n*,  work); 

printfC  Pos(km):  %10.3f  %10.3f  %l0.3fVn'. 
orbiter_gps_packet.gps_vector.pos.x  /  1000.0, 
orbiter _gps_packet.gps_vector.pos.y  /  1000.0, 
orbiter _gpsj>acket.^  vector.pos.z  /  1000.0); 
printfC  Posfkft):  %10T3f  *10.3f  *10.3f\n*, 
orbiter_gps_packet.gps_vector.pos.x  *  M_TO_KILOFT, 
orbiter _gps_packet.gps_vector.pos.y  "■  M_TO_KILOFT, 
orbiter_gps_packet.gps_vector.pos.z  *  M_TO_KlLOFT); 

printfC  Vcl(m/s):  ?H0.3f  *10.3f  «10.3f\n*, 
orbiter_gps_packet.gps_vector.vei.x  /  1000.0, 
orbiter_gps_packet.gps_vector.veI.y  /  1000.0, 
orbiter_gps_packet.gps_vector.vel.z  /  1000.0); 
printfC  Vel  (kft/s)  %10.3f  *10.3f  *10.3f\n*, 
orbiter_gps_packet.gps_vector.vel.x  ■"  M_TO_KILOFT, 
orbiter_gps_packet.gps_vector.vel.y  ■"  M_TO_KILOFT, 
orbiter_gps_packet.gps_vector.vel.z  "■  M_TO_KlLOFT); 


fclose(my_file); 

} 


* _ _ _ _ _ _ _ _ 

static  void  inain_key_process() 

{ 

int  key  =  key_get(); 

switch  (key) 

{ 

case  KEY_esc:  my_tenninate  =  YES;  break; 

} 


tans  v2.c 


tans  vsc.c 


*/ 

iKaclude  <stdio.h> 
j^nclude  <stdUb.h> 


iKnclude  <keys.h> 
include  <  tensj)kt.h  > 
#uiclude  <|4ct_if.h> 
#incliide  <sw^>.h> 


*  Week  697  is  16  May  1993. 

*  - */ 

static  int  my_teniiinate  »  NO; 

static  Tans_packet  my_packet; 

static  FILE  ''tey_fUe; 
static  int  my_file_done  —  NO; 

static  Tans_pkt_21_41  my_packet_41; 
static  Tans_pkt_43  my_packet_43; 
static  Tans_pkt_83  iny_packet_83; 


♦ - */ 

static  void 

do_file(char  ’'name), 
nuun_k^_process(void), 
process_packet_4 1  (void) , 
process j>acket_43(void), 
processjMcket_83(void); 

♦ - ♦/ 

int  tans_port_getbO 

{ 

int  rc; 

if  ((rc  =  fgetc(iny_file))  =  =  EOF)  niy_file_done  =  YES; 
retum  rc; 

} 


tans  VSC.C 


tans  vac.c 


* - •/ 

maiiiCiflt  $rge,  char  **argv) 

{ 

aUtic  char  insfO  * 

*\nTheae  keys  active  during  program:\n* 

*  ESC  stops  prognunVn* 

"VaHit  any  to  b^in*; 

/♦ - 

*! 

if(argc  <  2) 

( 

printf(”Usage:  %s  tans-fiiel  ...  tans*fileN\n'',  argv[0]); 
return; 

} 

puts(msg);  key_getO; 

for(argv+  +  ;  argc  >  1;  argv+  +  ,  argc— ) 

{ 

do_file(*argv); 

if  (my  terminate)  break; 

} 

} 


sssssssasssssBsssB:a3BsxaBs  =  =  =  s  =  s;  =  ssss 


static  void  do  fUe(char  "'tuune) 

{ 

if  ((my  file  =  fopen(iuune,  *rb"))  *=  =  NULL) 

{ 

printf(”Can’t  open  file  <%s>\n'',  luune); 
return; 

} 

printf("File  <%s>\n",  luune); 
my_file_done  =  NO; 

I* - 

*! 

for  (;;) 

{ 

/* - 

•/ 

if  (k^_hitO)  main_k^_proce8s0; 
if  (my_termiiute  1 1  my_fUe_done)  break; 


tans  vac.c 


tans_v«c . c 

I* - 

*1 

if  (Uns_jMcket_racv(&my_]Mcket)  »  ^  NO)  ctMitinue; 

if  (Dyj)acket.state  ! «  TANS  state  picket  ok)  continue; 

switch  (myj>acket.nw[l]) 

{ 

case  0x41:  process jMcket_410;  break; 
case  0x43:  process j>acket_430:  break; 
case  0x83:  process_packet_830:  break; 

defuilt:  break; 

} 

} 

fciose(niy_fi)e); 

} 


static  void  main  key_processO 
{ 

int  key  «  key _getO; 


switch  (key) 

{ 

case  KEY  esc:  my  terminate  =  YES;  break; 

} 


♦ - ♦/ 

static  void  process_packet_410 

{ 

int  size; 

Tans_itirt_21_41  "'packet; 

/* - 

*/ 

size  —  my_packet.cooked_si2e  -  sizeof(Tans_pkt_head)  -  sizeofinrans_pkt_tai]); 
if  (size  !=  sizeofi(Tans_pkt_21_41))  return; 

packet  «  (Tans_pkt_21_41  "O(myj)acket.cooked  +  8izeof(Tans_idct_head)); 

/* - - - 

"■/ 

tan«  vttc.c 


tana_v«e.c 

swap_float(&packet->wcs_of_week,  d[|Mcket->wcs_of_week); 
swap_fl<MU(&p«cket->gps_utc_ofhet,  &|iacket->g|M_titc_ofTiet); 
twap_sbort(&picket->week,  &packe(->week); 

printfCTime:  Week  %d.  tecs  %f,  utc  ofbet  IlfVn*.  packet- >  week, 
packet- >secs_of_week,  packet- >gpe_ittc_ofhet); 

myjpacket_41  «  Vpacket; 

/* - 

*/ 

//NOTE:  convert  GPS  time  to  UTC 

} 


* - */ 

static  void  ptxjcessjMcket  43() 

{ 

int  size; 

Tans_pkt_43  '^packet; 

/* - 

*/ 

size  *=  myj>acket.cocdced_size  -  sizeof(Tans_pkt_head)  -  sizeof(Tansj>kt_tail); 

if  (size  !=  sizeof(Tansjd(t  43)) 

{ 

printf(  "Velocity  pkt  size  %d\n'',  size); 
return; 

} 

packet  s  (Tans_pkt_43  *K>tiy_P>cket.cooked  +  sizeof(Tans_pkt_head)); 

/* - 

*/ 

swap_float(&packet->aol_time,  &packet->sol_time); 
sw^)_float(&packet->veI.x,  &packet->vel.x); 
swi4>_float(&packet->vel.y,  &packet->vel.y); 
swap_fIoat(&packet->vel.z,  &packet->vel.z); 
swap_float(d4>acket->gigo,  &packet->gigo); 

printfCVelocity  (m/s):  %10.3f  *10.3f  *10.3f  (*I0.3f)\n’. 
packet- >vel.x,  packet- >vel.y,  packet- >vel.z,  pack^->gigo); 

my_packet_43  *  "'packet; 

/* - 

*/ 

if  (myj>acket_41.week  !*  0  &&  my_packet_43.sol_time  my_packet_83.sol_time) 


tans  vac.c 


tans  vac.c 


{ 

//NOTE:  got  pos  and  vel  now,  uae  pkt  41  UTC  with  pkt  43/83  sol  time 

} 


typedef  struct  {  Vector  pos;  double  gtgo;  float  aol_time;  }  Tansjpkt_83; 

♦ - */ 

static  void  process jMcket  830 

{ 

int  size; 

Tans_pkt_83  Vpacket; 

/* - 

*1 

size  =  myjMcket.cooked^size  -  8i2eofi(Tans_pkt_head)  -  sizeof(Tansj>kt_taii); 

if  (size  !  =  sizeofirTans_pkt  83)) 

{ 

printfCPosition  pkt  size  %d\n”,  size); 
return; 

packet  ss  (Tans_pkt_83  *)(my_packet.cooked  +  sizeof(Tansj>kt_head)); 

/* - 

*/ 

8wap_fioat(&packet-  >  soi_time,  &packet-  >  sol_time); 
swap_double(&packet->pos.x,  &packet->pos.x); 
swap_doubie(&packet->pos.y,  ^^}acket->pos.y); 
swap_double(&packet->pos.z,  &packet->pos.z); 
sw^i_double(&packet->gigo,  &|mket->gigo); 

printfCPosition  (km):  %10.3f  %10.3f  %l0.3f  (%10.3f)\n*. 

packet->pos.x  /  1(XX).0,  packet- > pos.y  /  1000.0,  packet->pos.z  /  1000.0, 
packet- >gigo); 

myjpacket_83  =  '''packet; 

/V - 

*! 

if(myj>acket  41.wed(  !=  0  &&  myj>acket_43.sol_time  myjncket  83.sol  time) 

{ 

//NOTE:  got  pos  and  vel  now,  use  pkt  41  UTC  with  pkt  43/83  sol_time 

} 

} 


tans  vsc.c 


t«n«duap*c 


•/ 

#iiiclude  <ftdio.h> 
I^DcIude  <itdlib.h> 


fiiielude  <k^s.h> 
fiiielude  <taiu_pkt.h> 
fmclude  <pkt_if.h> 


*  Week  697  is  16  May  1993. 

♦  - - */ 

static  int  ■ny_teniiiiiate  ^  NO; 


static  TansjMcket  myjiacket; 
static  FILE  *my_file; 


♦ - */ 

static  void 

niaiii_k^_process(void), 

duiiip_it(char  *tidel,  char  *title,  *data,  ushort  bytes); 


* _ 

int  tans_poft _^b0  {  return  fgetc(iDy_file);  } 


■*/ 


TaDS_packet; 

ubyte  iaw[TANS_PKT_SIZE_RAW],  cooked[TANS_PICr_SIZE_COOKED] 
int  raw  size,  cooked_size,  state; 

* - 1 - */ 

inain(int  argc,  char 

{ 

static  char  msgQ  « 

”\nTliese  k^s  active  during  program:\n” 

*  ESC  stops  programVn* 

"Vnllit  any  k^  to  begin”; 


/* - 

•/ 

if  (argc  <  2) 


{ 


printf(*Usi9e:  %s  tans-data-file\n”,  argv[0]); 


tansduap.c 


tansduap'C 


ratum; 

} 

if((my_file  «  fopen(iiiv[l],  *rb*))  NULL) 

{ 

priDtf(*Can’t  open  file  <  %s>\n*,  argv[l]); 
return; 

} 

putsfmsg);  k^jgetO; 

/* - 

*1 

for  (;;) 

{ 

/* - 

*1 

if(key_hitO)  nudn_key_processO; 
if  (my_tenninate)  break; 

/• - 

*/ 

if  (tans_packet  recv(&my_packet)) 

{ 

if  (my_packet.  state  =  =  TANS  state  packet  ok) 

{ 

static  ushort  pkt_cnt; 
pkt_cnt+  + ; 

printfC^tSu  recv  %02x  =  %3d  bytes:*,  pkt_cnt,  my_packet.raw[l], 
my_packet.cooked_size  -  4); 

dunip_it('  *,  *\t\t\t  ",  myjMcket.cooked't-2,  myjMcket.codied  size-4); 

} 

else 

{ 

duinp_it(*bad  pkt  ",  "\t",  niyjMcket.raw,  myj»cket.raw_size); 

} 

} 

} 

fciose(my_file); 


* _ •/ 

^ic  void  main  k^_proceasO 

{ 

int  key  =  key _jetO; 


tanmdaap.c 


tansduaP'C 


■witch  (key) 

{ 

csie  KEY  eac:  my  tenninate  «  YES;  bteek; 

> 


■tetic  void  dump  it(cliir  '*titlel,  char  *title,  ul^  *data,  ushort  bytes) 

{ 

ushoft  cat; 

for  (cut  »  0;  cut  <  bytes;  cnt+  +  .  data++) 

{ 

if  ((cut  %  16)  »»  0) 

( 

if  (cut  ==  0)  printfC^s  ",  titlel); 
else  pruitf(*^%s  ",  title); 

} 

priiitfC"  %02x".  *daU); 

} 

fputc(’\n’,  stdout); 


tansduap.c 


t«st.e 


• - ■*/ 

l^lude  <stdlib.h> 
iKncIude  <stdio.h> 

#uiclude  <coiiio.h> 

iKnclude  <k^s.h> 

#iiiclude  <edit_rt.h> 
finclude  <tiiiies.h> 


* - ♦/ 

extern  int 

nuun_key_h«ndler(int), 

iiiain_dispUy_init(void), 

test_key_hafldler(int), 

te8t_display_iiiit(void), 

test_report(void); 


static  int  (♦my_key_handler)(int)  «=  nMun_key_handler; 
static  int  terminate  =  NO; 


*/ 


* _ ■  .  -  - - - - */ 

mainO 

{ 

niain_display_initO; 
for  (;;) 

{ 

if  (kbhitO) 

{ 

key_processO; 
if  (terminate)  break; 

} 

} 

gotoxy(l,  15); 
te8t_report0; 
test_timeO; 
test _gnq^csO; 

> 


t«st.c 


tMt.C 


• - */ 

Static  iat  k^_proceas(void) 

{ 

int  rc,  key  »  getchO; 

if  (key  »  ■*  0)  k^  »  getchO  +  0x100; 

re  =  ('*tey_k^_haiidler)(k^); 

if  (re  »«  2) 

{ 

iny_k^_handler  «  iiisiD_k^_haiidIer; 
main  display  initO; 

} 


/•* 


Returns: 

*  0  Didn’t  use  the  key 

*  1  Used  the  key 

*  2  Used  the  key.  My  sub^stem  is  done 

*  - */ 

static  int  main  key  haadler(uit  key) 

{ 

switch  (key) 

{ 

case  KEY_esc: 
terminate  ^  YES; 
return  YES; 

case  KEY_fl: 

if  (test_display_initO  YES) 

my_key_handler  »  test_k(^_handler; 
return  YES; 

} 

return  NO; 


typedef  struct  {  int  row,  col;  char  "text;  }  Label; 

mun  diq>lay  initO 

{ 

static  Label  labelsQ  = 

{ 


•/ 


{  6,16,  "Simulator  ...  yakity  yak  ...  grumble  grumble*}, 
{10,  6,  "FI  •  test  edit  1"}. 


t««t.c 


{12,  6,  'ESC  Exit'}. 
{  0,  0.  NULL  } 


t«St.C 


}; 

Label  *label; 

/* - 

*! 

clracrO; 

for  (label  s  labels;  label->text  !=  NULL;  labels -f) 

{ 

gotoxy(label-  >  col ,  label-  >  row); 
cputsOabel-  >  text); 

} 


int  test_tiiiieO 

{ 

double  Ume  =  ((((20  *  24)  +  2)  *  60.0)  +  15)  *  60.0  +  5.125; 

char  work[25]; 

int  day,hour,iDin,sec; 

Tiine_dluiis  dhins; 
double  tiine2; 

day  =  (int)(tiine/86400.0); 

hour=  (int)((tiine-day''^6400.0)/3600.0); 

min  =  (int)((time-day*86400.0-hour*3600.0)/60); 

sec  =  (int)(time-day*86400.0-hour*3600.0-min*60); 

printf(”brute  force:  %03d/%02d:%02d:%02d\n”,  day,bour,min,sec); 

printf(”time  routine:  %s\n",  time_dbl_to_string(&time,  work)); 

time  dbl  to  dhms(&time,  &dhms); 
printfCtim'to-hms:  %03d/%02d:  %02d: %02d.  %03d\n*. 
dhms.days,  dhms.hours,  dhms.mins,  dhms.secs,  dhms.msecs); 

time_dhms_to_dbl(&dhms,  &time2); 
printf(”timel  %lg\n*,  time); 
printf(''time2  %ig\n*,  time2); 


t«8t.C 


tMt  ccsm.c 


* - i*/ 

#include  <stdio.h> 

#iiiclude  <conio.h> 

#include  <edit.h> 

4^liide  <com_poit.h> 


* - */ 

static  int  iiut(void); 

static  void  test_set(int),  test_rx(int),  test_tx_keys(int),  test_tx_file(int); 

static  void  (*tests[])(int)  =  {  test_set,  test_rx,  test_tx_keys,  test_tx_file  }; 

#defuie  TESTS  (sizeof(tests)/sizeof(void  *)) 

static  char  iabelQ  « 

*\ii  Oexif 

*\ii  1  Baud-set  test” 

”\ii  2Rxtest" 

"\ii  3  Tx  test  -  keys" 

"\n  4  Tx  test  -  file" 

"\nwhicb  test:"; 


inain(int  argc,  char  """argv) 

{ 

int  port_id,  test; 

*/ 

if  ((port_id  =  initO)  *  =  0)  return; 

for  (;;) 

{ 

printfOabei);  scanf("%d",  &test); 
if  (itest  1 1  test  >  TESTS)  break; 
(*test8ltest-l])(port  id); 

} 

com_port_stop(port_id); 
return  0; 

} 


test  con.c 


t«0t  coa.c 


* _ 

static  int  initO 

{ 

int  port_id: 

ushort  rx_size,  tx_size; 


•*/ 


/♦ - 

*! 

port_id  =  edit_integer(''Enter  port  id  ",  1); 
rx_si2e  =  edit_integer( "Enter  rx  size  ",  512); 
tx_size  =  edit_integer("Enter  tx  size  ",  512); 

if  (com_port_start(port  id,  rx_size,  tx_size)  =  =  NO) 

{ 

printf("Can't  start  port  %d\n",  port_id); 
port_id  =  0; 
return  0; 

} 

return  port_id; 

} 


. . . . . . . . - . */ 

static  void  test  set(int  port  id) 

{ 

long  baud  =  edit_integer_long("Enter  baud  ",  9600); 

int  parity  -  edit_integer("Enter  parity  (0  none,  1  evoi,  2  odd)  ",  0); 

int  stops  =  edit_integer("Enter  stop  bits,  1  or  2  ",  1); 

parity  =  (parity  =  =  0 
?  COM_PORT_par_none 
;  (parity  ==  1 
?  COM_PORT_par  even 
:  COM_PORT_jw_odd)); 

8t<qjs  =  (stops  =  =  1  7  COM_PORT_stop_l  :  COM_PORT_stop_2); 
com_port_8et(port_id,  baud,  parity,  stops); 

} 


/♦=  =  =  =  =  : 


* - •/ 

Static  void  test  rx(int  port  id) 

{ 

char  '*^leoaine  =  edit_text("Enter  dump  file  (blank  for  none)  ",  "rx.dat" 
FII£  “^dunq); 


test  com.c 


t«at  coa.c 


/♦ - 

*/ 

dunq)  *  (fileiuune[0]  7  fopen(fileiiame,  ‘‘wb”)  ;  NULL); 

|mts(*Hit  any  key  to  stop”); 

for  (;;) 

{ 

int  value; 

if  (kbhitO)  {  if  (getchQ  *  =  0)  getchO;  break;  } 
if  ((value  =  com_port_get(port_id))  =  *  -1)  continue; 

printf(*  %02x”,  value); 
iputc(va]ue,  dump); 


if  (dump  !  =  NULL)  {  fnush(dump);  fclose(dump);  } 


* - */ 

sutic  void  test  tx  keys(int  port  id) 

puts("Hit  any  function-key  to  stop”); 

for  (;;) 

{ 

int  key; 

if  (!  kbhitQ)  continue; 

if  ((key  =  getchQ)  =  =  0)  key  =  getchQ  +  0x100; 

if  (key  >  0x100)  break; 
com_port_put(port_id,  key); 

} 

} 


* - *! 

static  void  test  tx  file(int  port_id) 

{ 

char  '"filename  =  edit  text(”Enter  file  name  ”,  ”rx.dat”); 

FILE  -"fUe; 

int  got_vaIue,  value; 


■"/ 


test  com.c 


test  coa.c 


if  (fiJeiuiDe{0]  *  «  0)  return; 

if  ((file  ■  fopenffUeouae,  "rb*))  =  =  NULL) 

{ 

printfC  Can’t  opeo  <%s>\n'',  fiJauune); 
return; 

} 


/* - - 

*/ 

puts(”Hit  any  key  to  stop*); 

got_value  =  NO; 
for  (;;) 

{ 

if  (kbhitO)  {  if  (getchQ  *=  *  0)  getcbQ;  break;  } 
if  (got_vaJue  =  =  NO) 

{ 

if  ((value  =  fgetc(file))  »=  EOF)  break; 
got_value  =  YES; 

} 

if  (coin_port_put(port  id,  value))  got  value  *  NO; 

} 

fclose(file); 
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*/ 

finclude  <sUiio.h> 
iKncIude  <coiuo.h> 
finclude  <fcntl.h> 
jKnclude  <io.h> 
jKnclude  <alloc.h> 

#include  <  vector.  h> 


*1 

extern  int  test_write(mt),  test_reed(int),  test_ioctl(iiit); 
iiit  (*tests[])(iiit)  =  {  test_write,  test_read,  test_iocti  }; 
#defu>e  TESTS  (sizeof(tests)/si2eof(void  '*')) 

char  labelQ  = 

"Nil  0  exitXn  1  write  testVn  2  read  test\n  3  iocti  testVn* 
"which  test:*; 

fdefine  0_RDWR_BIN  (0_RDWR  |  0_BINARY) 

Mefiae  FILE  IS  DEVICE  0x0080 
#define  FILE  IS  RAW  0x0020 
#define  nLE_SET_BITS  OxOOff 

iiuun(int  argc,  char  """argv) 

{ 

int  handle,  status,  test; 

/♦ - 

*/ 

if  (argc  <  2) 

{ 

printf(*Usage:  %s  device_naine\n",  argv[0]); 
return; 

} 


/♦ - 

*/ 

printf("Opening  device  <%s>\n*,  aigv[l]); 

if  ((handle  =  q>en(argv[l],  0_RDWR  BIN))  <  0) 

{ 

printf("Can’t  open  device  <%s>\n",  argv[l]); 
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return; 

> 

I* - 

*  If  file  is  a  device,  place  that  device  in  "rew*  mode. 

*/ 

status  s  ioctl(handIe,  0,  0,0); 

if  (status  St  HLEJS  DEVICE) 

{ 

status  »  (status  &  HLE_SET_BITS)  |  HLE_IS_RAW; 
ioctl(handle,  I,  status,0); 

} 


/♦ - 

*/ 

for  (;;) 

{ 

printfOabel);  8canf(*%d'',  dUest); 
if  (!test  j  I  test  >  TESTS)  break; 

(*tests[test-l])(handle); 

} 

/♦ - 

If  file  is  a  device,  place  that  device  back  in  "codced*  mode. 

*/ 

if  (sums  &  HLE  IS  DEVICE) 

{ 

sUtus  &=  ~F1LE_IS_RAW; 
ioctl(handie,  1,  sUtus,0); 

} 

close(handle); 

} 


*  -  - */ 

test_write(int  handle) 

{ 

struct  {  char  name[80];  int  handle;  ulong  size;  }  file; 
ubyte  *buffer,  •bptr; 
ushort  bsize,  cnt; 
int  bytes,  rc; 

/* - 

*1 

printfCenter  filouune:  ”);  scanfC'^Is”,  file.name); 
if  ((file.handie  =  open(file.name,  0_RDWR_BIN))  <  0)  remrn; 
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file-size  -  UeekCfUe.liaiidle.  OL.  SEEK  END); 

lfeek(file.lMiidle,  OL.  SEEK_SED; 

print^''fiie  <  %s>  is  %ld  l^tesVa*,  file.iijujie,  file.stze); 

buffer  iii«lloc(bsi2B  v  0x4000); 

if  (buffer  »  B  NULL)  {  close(fUe.hsfidle);  reOim;  } 

/* - 

*! 

for  (cnt  B  0,  bytes  ^  0;  ;  ) 

{ 

if  (bytes  <  =  0) 

{ 

bytes  s  reaid(fiie.hjuidle,  buffer,  bsize); 
if  (bytes  <  »  0)  bresk; 
bptr  »  buffer; 

} 

rc  s  _write(hsiidle,  bptr,  l^tes); 
if  (rc  >  0) 

{ 

cnt+  +  ; 

bptr  +SS  rc;  bytes  -=  rc; 
pruitf(''\r%3d  wrote  %d  bytes\n”,  cnt,  rc); 

} 

if  (kbhitO)  bresk; 


ciose(file.bandle); 

free(buffer); 


* - - */ 

test  read(int  handle) 

{  ~ 

struct  {  int  handle;  ushort  size;  }  file; 
void  "'local; 
int  rc; 

/* - 

*1 

pruitf(”enter  size:  ”);  scaaft'^i",  &file.size); 
if  (file.size  =  =  0)  return; 

if  ((local  as  n)alloc(file.8ize))  —  ^  NULL)  return; 

if  ((file.handle  *  open(”te8t.dat'',  0_RDWR_BIN  1 0_CREAT,  0666))  <  0)  return 

/* - 
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*/ 

for  (;;) 

{ 

rc  _i— dQumdle,  local.  file.aize): 

if(rc  >  0) 

{ 

priittf(*i«ad  %d  byteaVn",  rc); 
write(fUe.liaiKUe.  local,  rc); 

) 

if  (kbhitO)  break; 


close(file.liaiidle); 

fireeOocal); 


test  ioctl(int  handle) 

{  ■ 

struct  {  int  type;  ubyte  data[10];  }  msg; 
int  rc; 

for  (;;) 

I 

msg.type  *  4; 

strcpy(insg.data.  "123436789"); 

rc  —  ioctl(bandle.  2.  &nisg.  sizeof(insg)); 

printf("ioctl  %d  bytes\n".  rc); 

break; 

} 
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/' 


♦ - •/ 

fiiicliide  <s(dio.h> 
include  <iiieiii.h> 

fiiicliide  <vector.h> 

^include  <coiist.h> 
finclude  <orbiiwchI.h> 


*/ 

double  iiiSOefe[3][3],  i]o«d_t_epoch; 
extern  void 

vectcnv(double  time.  Vector  •ecef_r.  Vector  *ecef_v.  Vector  •in50_r.  Vector  •in50_v,  int  flg); 

Mefine  ECEF  TO  M50  0 
Mefine  M50_fo_iCEF  1 

Mefiiie  MSO  TO  WGS84  0 
idefine  WG^_fo_MSO  1 


/*»  =  ==  =  = 


*/ 

static  State_vector_traiisform  iiiSO_ecef; 


♦/ 

static  int 

load_niatrix(void); 
static  void 

show_vector(State_vector  *v,  char  *label), 
show_vector_diff(State_vector  ♦vl,  duu  *label,  Stde_vector  *v2), 
aiK)w_transforni(State_vector_traosform  *svt,  char  *label), 
read_vector(State_vector  *v,  double  *dtime,  int  •time_iel); 

static  void 

te8t_aet_ecef_vector(void), 

test_old_ecef_to_niSO(void), 

test_new_ecef_to_ni50(void), 

test_iips_ecef_to_inSO(void), 

test_set_ni50_vector(void), 

test_old_ni50_to_ocef(void), 

te8t_new_ni50_to_ecef(void), 

•®**_“P*_*“^_*®_ecef(void), 


t«st  vec.c 


t««t  v«c.c 


test_sliow_tnuisfoniu(void). 

test_nuke_tniisfonii(void); 


/*m  ms  St  SB  I 


*/ 

void  C'iestsQKvoid)  » 

{ 

test_set_ecef_vector,  test_old_ecef_to_m50,  test_Dew_ecef_to_m50,  test_nps_ecef_to_iiiSO, 
test_a^_inSO_vector,  test_old_inSO_to_ecef,  test_iiew_in50_to_ecef,  test_nps_in50_to_ecef, 
test  show  tmisfonns,  test  niske_traiisfonn 


#define  TESTS  (sizeof(test8)/sizeof<void  *)) 

char  labelQ  = 

■\n  0  exit" 

*\ii  1  set  ecef  vector"  "\t  5  set  mSO  vector" 

"\n  2  old  ecef-to-mSO"  "\t  6  old  mSO-to-ecer 
"\ii  3  new  ecef-to*in50"  "\t  7  new  mSO-to-ecer 
*\n  4  NFS  ecef-to-mSO"  "\t  8  NFS  mSO-to^er 
"\n\t\t\t  9  Flint  transforms" 
"\n\t\t\t  10  Update  transform" 

"\nwhich  test:"; 


*/ 

typedef  struct 

{ 

State_vector  vector; 
double  dtime; 
int  time_rel; 

}  My_vector_info; 

static  My  vector_info  ecef  = 

{ 

{ 

{  913061.83  *  M  TO  FT,  -5527811.25  *  M_TO_FT.  3037681.65  *  M_TO_FT  }, 
{  0.0,  0.0,  0.0 
0.0 

}. 

0.0,  YES 

}; 


static  My  vector  info  m50  = 

{ 

{ 

{  11694900.0,  -14218100.0,  9917380.0  }. 

{  1044.00562,  843.50684,  4.32033  }, 
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0.0 

}. 

0.0,  YES 


/♦a 


♦ - ♦/ 

iiMiii(int  aijc,  char  **»xgv) 

{ 

int  test,  year; 

/* - 

*/ 

if  (load_matrixO  =  *  NO)  return; 

printfCEnter  year:');  scanf(*%d*.  &year); 
bgprop_year(year); 

if  (bgprop_initO  ^  —  NO)  return  NO; 

/* - 

•/ 

for  (;;) 

{ 

printfOabel);  scanf(”%d”,  &test); 
if  (!test  1 1  test  >  TESTS)  break; 

(''tests[test>l])0; 

} 

} 


* - */ 

static  int  load  matrixO 

{ 

char  name{80]; 

FIL£*iload; 

/♦ - 

*/ 

printf(*Enter  Uoad  filename:”);  name[0]  —  0;  scanf(”%s*,  name) 
if  (name[0]  s  s  0)  return  NO; 

if  ((iload  s  fopen(iuune,  ”r*))  » s  NULL)  return  NO; 

/* - 

*/ 

fscanf(iload,  *%le”,  &iload  t  q>och); 

fscanfiUoad,  '%le  %le  %le~%le  %le  %le  «le  «te  %le”. 
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&in50efe(0][0],  &inS0efe(0][l],  &inS0efe(0][2]. 
&in50efe{lK0].  &inSOefe(]Kl],  &iiiS0efe(lK2]. 
&iBS0efe[2][01.  &]iiS0efe[2}[l].  &mS0efe[2][2]); 
fcIose(iIoad): 


inSO_ecef.tiiiie  =  Uoad_t_epoch; 

meiiKpy(inSO_ecef.  matrix,  mSOefe,  si2Bofi(mSO_ecef.  matrix)); 
retufn  YES; 

} 


* - */ 

static  void  show_vector(State_vector  *v,  char  "‘label) 

( 

static  char  foitlG  « 

'•*s\ii'' 

•  *13.31fx  xdot\n* 

-  «13.31fy  *11.5lfydot\ii- 

•  %13.31fz  *n.5lf  2dot\ii* 

*  %13.3lfmag  ^n-Slfmagyn* 

*  time  5Hf\n"; 

printf(fmtl,  label, 

v->pos.x,  v->vel.x,  v->pos.y,  v->vel.y,  v->pos.z,  v->vel.z, 
vector_magiiitiide(&v>>pos),  vector_magnitude<&v->vel),  v->time); 


static  void  show  vector  diffi(State  vector  "Vl,  char  "‘label.  State  vector  *v2) 

{  ■  ■  ■ 
static  char  fintlQ  « 

''*s\n'' 

'  %13.3lfx  %11.51fxdot  I  %13.3lfx  %11.5lf  xdotNn" 

*  %13.31fy  %11.5lfydot  \  %13.31fy  «11.5lf  ydotVa" 

*  %13.3lfz  %ll.Slfzdot  I  «13.31fz  %ll.Slf  zdotXn* 

"  %13.3lf  mag  %11.5lf  mag  |  %13.3lf  mag  magNn" 

*  time  %lf\ii*; 

State_v6Ctor  delta; 

vector_difT(&vl->pos,  &v2->pos,  dcdelta.pos); 
vector_dilf(&vl->vel,  &v2->vel,  &delta.vel); 
priiitf(fmtl,  label, 

vl->pos.x,  vi->vel.x,  delta.pos.x,  delta. vel.x, 
vl->pos.y,  vl->vel.y,  delta.pos.y,  delta.vel.y, 
vl->pos.z,  vl->vel.z,  delta.pos.z,  delta.vel.z, 
vector_magiutude(&v  I  •  >  pos) ,  vector_magnitude<&v  1  -  >  vel) , 
vector_magnitude(&delta.po8),  vector_niagnitude(&delta.ve]), 
vl->time); 
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}; 


static  void  show  tiaiisfonii(State  vector  transform  ^svt,  char  *label) 

{ 

static  char  fintQ  » 

''%8  time:  %20]f\n' 

''\t%20le  «20le  ftlOleNn* 

"VtftWle  %20le  «20le\n' 

*\t%20le  «20ie  %20ie\n': 

printf(fmt,  label,  svt->time, 

svt- >  matrix[0][0],  svt->matrix[0][l],  svt->matrix[0][2]. 
svt->matrix[ll(0],  svt->matrix[ll[ll,  svt- >  matrix[l][2]. 
svt->matrix[2][0],  svt->matrix[21[ll.  svt->matrix[2][2]); 

} 


static  void  read  vector(State  vector  double  ‘Mtime,  int  'Hime  lel) 

{  "  ■ 
char  answer(80]; 

int  is_meters: 

/* - 

*1 

8how_vector(v,  "Existing  vector;  *); 
plinth"  dtime  %if\n'',  'Mtime); 

printf(”Change  vector  ?  ");  answer[0]  —  0;  scanf(''%s'',  answer); 
if(answer{0]  ==  ’y’) 

{ 

printf( "Enter  meters  or  ft  ?  ");  answeifO]  =  0;  scanf("%s",  answer); 
is_meters  *  (answer[0]  =  =  ’m’  ?  YES  :  NO); 

printf("Enter  x  y  z  xdot  ydot  zdot:  "); 

8canf("%lf  %lf  %lf  %lf  %lf  %ir,  &v.>pos.x,  &v->pos.y,  &v->pos.z, 
&v->vel.x,  &v->vel.y,  &v->vel.z); 

if  (is  meters) 

{ 

v->pos.x  •*  M_TO_FT;  v->pos.y  *=  M_TO_FT;  v->pos.z  *=  M_TO_FT; 
v->vel.x  M_TO_FT;  v->vel.y  *=  M_TO_FT;  v->vel.z  ♦=  M  TO  FT; 

} 


/*■ 
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*/ 

printfCCluuige  time  ?  *);  answerCO]  0;  scaafi('‘%s*.  answer); 
if  (answeifO]  *  =  ’y’) 

{ 

printft'Enter  abs/rel  time:  *); 
answerfO]  —  0;  scanf(''%s  %ir,  answer,  dtime); 
if  (answeifO]  =  »  ’r’)  *time_rel  =  YES; 

else  if  (answer[0]  =  »  ’a’)  "lime  rel  »  NO; 

} 

show_vector(v,  "Vector  in  ft"); 
printf("  dtime  %lf\n",  '"dtime); 


* - */ 

static  void  test_set  ecef_vector(void) 

{ 

read_vector<&ecef. vector,  dcecef.dtime,  &ecef.time_rel); 

) 

static  void  test  old  ecef  to  m500 

{ 

State_vector  m50_new; 

if  (ecef.time_rel)  ecef.vector.time  *=  iload_t_epocfa  +  ecef.dtime; 
else  ecef.vector.time  =  ecef.dtime; 

vectcnv(ecef .  vector,  time, 

&ecef.vector.pos,  &ecef. vector. vel, 

&m50_new.pos,  &mSO_new.vel,  ECEF_TO_M50); 
m50_new.time  =  ecef.vector.time; 

sliow_vector(&ecef. vector,  "Vector  ECEF"); 

show_vector_difF(&m50  new,  "Vector  M50\t\t\t\t\tM50  -  Ref  M50",  &in50. vector); 

} 

static  void  test  new  ecef  to_mS00 

{ 

State_vector  m50_new; 

if  (ecef.time_rel)  ecef.vector.time  =  iload_t_epocb  +  ecef.dtime; 
else  ecef.vector.time  ecef.dtime; 

state  vector  ecef  to  mS0(&ecef. vector,  &m50_new,  &mS0_ecef,  YES); 
mS0_new.time  —  ecef.vector.time; 

show_vector(&ecef. vector,  "Vector  ECEF"); 

diow_vector_diff(&m50_ncw,  "Vector  M50\t\t\t\t\tM50  -  Ref  M50",  &mS0.vector); 
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} 

static  void  test  nps_ecef  to_inSOO 

{ 

Stste_vector  in50_new; 

if  (ecef.tiiiie_rel)  ecef.vector.time  =  ilosd_t_epoch  +  ecef.dtime; 
else  ecef.vector.time  —  ecef.dtime; 

mS0_wgs84_mS0(&ecef. vector,  SuaSO_aew,  WGS84_TO_M50,  NULL,  YES); 
m50_new.time  —  ecef.vector.time; 

show_vector(&ecef. vector,  "Vector  ECEF"); 

show_vector_diff(&m50_new,  "Vector  M50\t\t\t\t\tM50  -  Ref  M50",  &inSO. vector); 


* - - */ 

static  void  test_set_m50  vector(void) 

{ 

read  vector(&mSO. vector,  dunSO.dtime,  dcmSO.time  rel); 

} 

static  void  test_old  m50_to  ecefO 

{ 

State_vcctor  ectf_new; 

if  (mSO.timerel)  mSO.  vector,  time  =  iload_t_epoch  +  mSO.dtime; 

else  mSO.vector.time  =:  mSO.dtime; 

vectcnv(mSO.  vector,  time, 

&ecef_new.pos,  &ecef_new.vel, 

&mSO.  vector,  pos,  &mSO.  vector,  vel,  M50_TO_ECEF); 
ecef_new.time  =  mSO.vector.time; 

show_vec*or(&mSO. vector,  "Vector  MSO"); 

show_vector_diff(&ecef_new,  "Vector  ECEF\t\t\t\t\tECEF  -  Ref  ECEF",  &ecef. vector); 

} 

static  void  test_new_mSO_to_ecefO 

{ 

State_vector  ecef_new; 

if  (tnSO.time_rel)  mSO.vector.time  =  iload_t_epoch  +  mSO.dtime; 
else  mSO.vector.time  ==  mSO.dtime; 

state_vector_mSO_to_ecef(&mSO.vector,  &ecef_new,  &mSO_ecef,  YES); 
ecef  new.time  =  mSO.vector.time; 
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show_vector(&in50. vector,  "Vector  M50"); 

show  vector_diff(&ecef_new,  "Vector  ECEF\t\t\t\t\tECEF  -  Ref  ECEF",  &ecef. vector); 

} 

static  void  test_Dps  mSO  to  ecefQ 

{ 

State_vector  ecef_new; 

if  (mSO.tiiDe_rel)  mSO.  vector,  time  =  iload_t_epoch  +  mSO.dtime; 

else  mSO.vector.time  «  mSO.dtime; 

mS0_wgs84_mS0(&mS0. vector,  &ecef_new,  M50_TO_WGS84,  NULL,  YES); 
ecef_new.time  =  mSO.vector.time; 

show_vector(&mSO.vector,  "Vector  MSO"); 

show_vector_diff(&ecef_new,  "Vector  ECEF\t\t\t\t\tECEF  -  Ref  ECEF",  &ecef. vector); 


* - *! 

static  void  test  show  transformsO 

{ 

State_vector  ecef_gigo; 

State_vector_traiisform  ecef_mSO_new,  mSO_ecef_oew; 

if  (mSO.time_rel)  mSO.vector.time  =  iload_t_epoch  +  mSO.dtime; 
else  mSO.vector.time  =  mSO.dtime; 

mS0_wgs84_mS0(&mS0. vector,  &ecef_gigo,  MSO_TO_WGS84,  &mSO_ecef_new,  YES); 
show_transform(&mSO_ecef_new,  "Computed  MSO  to  ECEF"); 

state_vector_rotate_mSO_ecef(&mSO_ecef,  mSO.vector.time,  &ecef_mSO_new); 
matrix_transpose(ecef_mSO_new.matrix,  mSO_ecef_new. matrix); 
mSO_ecef_iiew.time  =  ecef_mSO_new.time; 
show_transform(&mSO_ecef_new,  "I-Load  MSO  to  ECEF"); 

) 

static  void  test_make  transformO 

{ 

State_vector  mSO _gigo,  ecef _^go; 

State_vector_transform  mSO_ecef_new; 

mSO_gigo  —  mSO.  vector; 
printf("Enter  abs  time:  "); 
scanf("%ir,  &mSO _gigo.time); 

mS0_wgs84_mS0(&mS0 _gigo,  &ecef_gigo,  MSO_TO_WGS84,  &mSO_ecef_new,  YES); 
show_transform(&mSO_ecef_new,  "Computed  MSO  to  ECEF"); 
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mSO_ecef  *  m50_ecef_iiew; 
iIoad_t_epoch  —  iiiSO_ecef.time; 

meoKpyCinSOefe,  inSO_ecef. matrix,  8izeof(inS0_ecef.inatrix)); 
■liow_traiuifonii(&mSO_ecef,  "I-Load  MSO  to  ECEF*); 
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/** 


^include  <stdlib.h> 
#bclude  <stdio.h> 
#iiiclude  <ccniio.h> 

iKinclude  <keys.h> 
#uiclude  <edit_rt.h> 


■*/ 


* _ */ 

static  int  inti  =  10,  int2  =  33; 

sutic  double  dbll  =  3.141S926S3S9,  dbl2  =  1.414e20; 


*-123456789  123456789  123456789  123456789  123456789  123456789 
*  1 

*  2  Hello  There 
*3 

*4  Inti;  X 
*5  Inti:  X 
*6 
*7 

*8  dbll:  X  dbl2:X 

*9 

static  EdiMabel  my  labelsQ  = 

{ 

{  2,  4,  "Hello  There"}, 

{4,  4,  "Inti:"}, 

{  5,  4,  "Int2:"}, 

{  8,  4,  "dbll:"}, 

{  8,34,  "dbl2:"} 

}; 

^define  LABEL_COUNT  (sizeof(my_labels)/sizeof(Edit_iabel)) 

static  Edit  field  my  fieidsQ  = 

{ 

{  4,10,  edit_field_get_mt,  edit_field_put_int,  edit_field_key_int,  &intl  }, 

{  5,10,  edit_field_get_int,  edit_field_put_int,  edit_field_key_int,  &int2  }, 

{  8,10,  edit_field_get_dbl,  edit_field_put_dbl,  edit_field_key_dbl,  &dbll  }, 
{  8,40,  edit_field_get_dbl,  edit_Eeld_put  dbl,  edit  field  key  dbl,  &dbl2  } 

}; 

#deEne  FIELD_COUNT  (sizeof(my_fields)/sizeof(Edit_field)) 

static  Edit_screen  my_screen  = 

{ 


testl.c 
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LABEL  COUNT,  my  labels, 
HELOJCOUNT,  my  fields 

}; 


/*« 


'*  Returns: 

*  0  Didn’t  use  the  key 

*  1  Used  the  key 

2  Used  the  key.  My  subsystem  is  done 

*  - ♦/ 

int  test_key_faandler(int  key) 

{ 

return  edit_screen_key_handler(&my_screen,  key); 

} 


_ _  _ ........ - - */ 

test_display_initO 

{ 

edit_screen_init(&my_screen); 
return  YES; 

} 


/*= 


* - - - - m/ 

int  test_reportO 

{ 

printfCXnintl  ;  ftdVn",  inti); 
printf(''int2  :  %d\n'',  int2); 
printfCdbll  :  %lg\n",  dbll); 
printf(''dbl2  :  %lg\n\n'',  dbl2); 
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* _ 

^include  <coiuo.h> 
finclude  <graphics.h> 

Mefiiie  FONT  SIZE  4 
#defue  HORIZ_DIR  0 


■*/ 


* - ♦/ 

bt  test_giaphicsO 

{ 

int  gdriver  =  DETECT,  gmode,  font; 

int  base,  cnt; 

char  work[40],  ■'^vptr; 

printfCVnVnEnter  font  M  *);  scanfC^d*,  &font); 
initgi«ph(&gdriver,  dcgmode,  *”); 
settextstyle(font,  HORIZ_DIR,  FONT_SIZE); 

for  (base  =  0;  base  <  256;  base  +  =  16) 

{ 

for  (wptr  =  work,  cnt  =  0;  cnt  <  16;  cnt++,  wptr  +=  2) 

{ 

if  ((wptr[0]  =  base  +  cnt)  ==  0)  wptr[0]  =  ’  ’; 
wptr[l]  =  ’  ’; 

} 

clearviewportO; 
outtextxy(2,2,  work); 
getchO; 

} 

closegraphO; 
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!*» 


* - •/ 

iKnclude  <iiiath.h> 

extern  double  inS0efe[3][3],  ilowl_t_q>och: 
extern  void 

dmvmul(doubIe  iii[3][3],  double  vl[3],  double  v2[3]), 
eftoiii50(double  time,  double  meAn5(^3](3]), 
dxpose(double  in[3][3],  double  mt[3][3]); 


* _ */ 

jNfdef  GIGO 

static  shov.'_vector(char  ‘‘title,  double  v[3]) 

{ 

pnntf("*s\t%201f  %20lf  *20lf\n*,  title,  v[01,  v[ll,  v[21), 

} 

static  show  niatrix(char  '“title,  double  in{3][3]) 

( 

static  char  iintG  «= 

•%s\t%201f  «201f  %20lf\n^ 

•\t\t%201f  %20lf  %201f\n'' 

"\t\t%20lf  %20lf  *201f\n"; 


printf(fint,  title, 
ni[01[0],  m[0][l],  mlOlPl, 
in[l][01,  mll][l],  tnlUra, 
inI21(0],  inl2][l],  iii[2][2]); 

} 

#eiidifGIGO 


fig  *  0  ECEF  ->  M50 
•“fig  *  1  M50  ->  ECEF 

* - */ 

void  vectcnv(double  time,  double  r  ecef[3],  double  v_ecef[3],  double  r  mS0[3],  double  v  mS0[3],  int  fig) 

{ 

double  Earth_Rate  =  7.292n514646e-S: 
double  omega[3],  omegaxr[3],  mefmSO[3][3]; 
double  vtemp[3],  mm50ef[3][3]; 


ef)omSO(time,mefinSO); 

omega[0]  «  Earth_Rate  *'  mSOi  '^2][0]; 
omega[l]  »  Eafth_Rate  *  mS0efe(2][l]; 
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oiiiega[2]  »  Earth_Rate  *  mS0efe(2][2]; 

if(flg  *»  0) 

{ 

dmvinul(iDefniSO,r_ecef,r_iDSO); 

omegaxiiO]  »  oiiiega[l]*r_inS0[2]  -  omega[2]*r_m50[l]; 

omesaxr[l]  »  oiiKga[2]*r_iiiS0[0]  •  omegs[0]*r_inS0(2]; 

oiiiegaxr[2]  »  omega[0]'t_mS(Hl]  -  omega[I]'*^_mS0[0]; 

daivmul(iiiefiiiSO,v_ecef,v_iiiSO); 

v_mS0{0]  -f  =  omegaxrfO];  v_iiiS0{l]  +=  ooiegiLXTfl]; 

} 

else 

{ 

omegaxifO]  =  oiDega[l]’^_inS0[2]  -  oinega[2]'*t_inS0[I]; 

omegaxr{l]  =  oiiiega[2]*r_m50[0]  -  oiDega[0]'*r_in50[2]; 

omegaxr(2]  =  oiDega[0]'*^_inS0[l]  -  oinega[l]'*t_inS0[0]; 

dxpose(iiiefinS0,iniii50ef): 

dmvmuJ(iiiinS0ef,r_iii50,r_ecef); 

vtempIO]  =  v_in50(0]  -  omegaxifO]; 

vteinp[l]  =  v_in50[l]  -  omegaxr[l]; 

vteiiip[2]  =  v_inS0[2]  •  omegaxr[2]; 

dmvmul(iiiinSOef,vteinp,v  ecef); 

) 


* - *! 

void  eftoniSO(double  time,  double  mefni50[3][3]) 

{ 

double  delt,  clam,  slam,  lam; 
double  eai1b_nite  =  7.2921 15 14646e-5; 

delt  =  time  -  iload_t_epocb; 
lam  =  eaTth_rate'*'delt; 
clam  =  cos(lam); 
slam  =  sinOam); 


mefm50[0][0]  »  m50efe[0][0]'^;lam  +  m50efe[l][0]^lam; 
mefmS0{0][l]  s  •mS0efe{0][0]'*^lam  +  mS0efe[l][0]’'%lam; 
meimS0(0][2]  »  m50efe[2][0]; 

mefmS0{l][0]  s  mS0efe[0][l]''%lam  +  m50efe[l][l]''^lam; 
mefm50[l][l]  »  -mS0efe[0][l]*slam  +  m50efe[l][l]*clam; 
mefmS0[l][2]  «  mS0efe(2][l]; 

mefmS0[2][0]  »  mS0efe[0][2]*clam  +  mS0efe[l][2}*slam; 
mefm50{2][l]  «  -ni50efe[0][2]*slam  +  mS0efe[l][2]'^;lam; 
mefmSO[2][21  >  mS0efe[2][2]; 

} 

void  dmvmul(double  m(3][3],  double  vl[3],  double  v2[3]) 
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{ 

int  ij; 

for(isO;  i<3;  i++) 

{ 

v2lil  «  0.0; 
fbi<j“0;  j<3;  j++) 

v2Ii]  «  m(i]Ij]*vlGl  +  v2Iil; 

} 

} 

void  dxpose(double  in{3][3],  double  iiit[3][3]) 

{ 

int  iJ; 

for(i=0;  i<  3;  i++) 
for(j=0;  j<3;  j++) 

} 
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iKnclude  <stdio.h> 
jKnclude  <stdlib.h> 
#incliide  <cooio.h> 


/*s«: 


* - 

int  maiiiCint  argc,  char  *'*argv) 

{ 

static  char  msgQ  = 

"Usage;  %s  modeXn" 

*  3  Normal  80x25  color\n* 

"  64  EGA  43.  or  VGA  50  line  colorVn"; 


/f - 

*! 

if  (argc  =  =  2) 

{ 

int  mode  =  atoi(argv[l]); 

if  (mode  =  =  3  1 1  mode  =  =  64) 

{ 

textmode(mode); 

return; 

} 

} 

printf(msg,  argv[0]); 


vatodo.c 


Jc«£ile 


BCC_PATH  «  c:\utU\bcc 

UBPATH  -  $(BCC  PATH)\Iib 
INCPATH  »  iiic;$(BCC_PATH)Vinc 

.ptth.obj  s  objs 


CO  s  cOl.obj 
CUB  =  cl.lib 

MATHUB  =  fp87.1ib  nutU.lib 
GRAPHUB  graphics,  lib 

RM  =  im 

TJS_DBUG  =  p_map 

#RM  =  erase 
)(rrJS_DBUG  =  echo 


#  For  Rendezvous: 

#  make  clean 

#  make  -DRNDV  pgm.exe 

# 

!if  $d(RNDV) 

CEXTRA  =  $(CEXTRA)  -DNPS_RNDV 
lendif 


#  For  GPS: 

#  make  clean 

It  make  -DGPS  pgm.exe 

# 

!if$d(GPS) 

CEXTOA  =  $(CEXTRA)  -DNPS_GPS 
lendif 

lif  $d(SIM) 

CEXTRA  =  $(CEXTRA)  -DNPS_SIM 
lendif 

CC  =  bcc 
AS  =  tasm 
LD  s  tlink 
AR  =  tlib 


aakefile 
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iif$d(DEBUG) 

CDEBUG  -  -N  -V  -y  -DDEBUG 
ielse 

CDEBUG  «  -N  -V  -y 
!eodif 

ADEBUG  «  -zi 

AFLAGS  «  -ml  -Unc  $(ADEBUG)  -j.286P 

#  For  Debuging: 

#  make  -DDEBUG  pgm.exe 

» 

•if  $d(DEBUG) 

LFLAGS_DEBUG  *  /m/l/v 
iendif 

LFLAGS  ==  /c/d$(LFLAGS_DEBUG) 
.AUTODEPEND 

#  Implicit  rules 

# 

{nps}.c.obj: 

$(CC)  -c  -Inps  {$<  } 

{tans}.c.obj: 

$(CC)  -c  -Itans  {$<  } 

{orbmecbl}.c.obj: 

$(CC)  -c  -lorbmechl  {$<  } 

{uti]}.c.obj: 

$(CC)  -c  {$<  } 

{util}.asm.obj: 

$(AS)  $(AFLAGS)  $  <  .$® 

{com}.c.obj; 

$(CC)-c  {$<  } 

{com}.asm.obj: 

$(AS)  $(AFLAGS)  $<,$® 
{np8_sim}.c.obj: 

$(CC)  -c  -lnps_sim  {$<  } 
{tans_sim}.c.obj: 

$(CQ  -c  -Itans_sim  {$<  } 

{test}.c.obj; 

$(CC)  -c  {$<  } 


#=  = 


nothing: 

®ecbo  "Type  ’make  TARGET’  where  target  is  one  oP 

®echo  "  tans.exe .  TANS,  with  NPS  *****  STS-51  Flight  Version 


makefile 


Oecho  ”  Uns_8pd.exe.  TANS,  no  NPS,  with  SPDRIVE* 

Oecho  '*  Uuis51sin.exe.  TANS,  with  NPS,  Sim  from  file* 

®echo  *  UnsSlfh.exe.  TANS,  no  NPS,  testing* 

®echo  *  tsim.exe .  TANS  device  simulator* 

Oecho  *  t6st_com.exe.  Corn-port  tester  (via  built-in  interrupts)* 

®echo  *  test_dev.exe.  Corn-port  tester  (via  DOS  device  driver)* 

Oecho  *  com_txrx.exe.  Com-port  two-way  tester  (via  built-in  interrupts)* 

®echo  *  vmode.exe....  Video-mode  switcher* 

Oecho  *  scom.exe .  NPS  Simulator,  input  com-port  (built-in),  no  output* 

Oecho  *  sdev.exe .  NPS  Simulator,  input  com-port  (DOS  driver),  no  output* 

®echo  *  sdev_dly.exe.  NPS  Simulator,  input  device/disk  (TLM  packets),  no  output* 

6«cho  *  sprp.exe .  NPS  Simulator,  input  propagator,  no  output* 

@echo  *  sdsk.exe .  NPS  Simulator,  input  disk,  no  output* 

®echo  *  smem.exe .  NPS  Simulator,  mput  memory  (from  disk),  no  output* 

@echo  *  prp_dsk.exe..  NPS  Generator,  input  propagator,  output  disk* 

®echo  *  prp_dev.exe..  NPS  Generator,  input  propagator,  output  corn-port  (DOS  driver)' 
®echo  *  prp_com.exe..  NPS  Generator,  input  propagator,  output  com-port  (built-in)* 

®echo  *  nps.exe .  NPS  Stand-alone,  input  com-port  (built-in)* 

(^echo  *  test_vec.exe.  Vector  functions  tester* 

(^ecbo  *  map_raw.exe. .  Map-file  converter,  text  to  raw* 

®echo  *  enun_test.exe.  EMM  fimctions  tester* 

@echo  *  tansdump.exe.  TANS  data-file  dumper* 

(^echo  ”  tans_vec.exe.  TANS  data-file  vector  dumper* 

®echo  "  tans_v2.exe..  TANS  data-file  state-vector  dumper* 

@echo  *  pkt_cln.exe..  Packet  file  filter/cleaner* 

®eciio  *  pkt_show.exe.  Packet  file  dumper* 


clean: 

-$(RM)  turboc.cfg 
-$(RM)  objs\nps.obj 
-$(RM)  objs\nps_dap.obj 
-$(RM)  objs\npsj}red.obj 
-$(RM)  objs\nps_edit.obj 
-$(RM)  objsVsprop.obj 
-$(RM)  objsXscom.obj 
-$(RM)  objs\scom_dly.obj 

#  Object  file  groups 

# 

ORBMECH_OBJS  =  amatrix.obj  bgprop.obj  cowell.obj  der.obj  gem9.obJ  getiers.obj  \ 
gotpot.obj  itowgs84.obj  Jacatm.obJ  jacdat.obj  mSOmp.obj  rk4.obj  util.obj 

EDIT  OBJS  *  edit.obj  key_get.obj 

EDIt"rT_OBJS  =  $(EDIT_OBJS)  edit_rt.obJ  edit_fld.obJ 


makefile 


mak«£lle 


T1ME_OBJS  »  thms_dbl.obj  tdbl_str.obj  tdbl_hiss.obj  thms  str.obj  tgps  utc.obj 

VECTOR_OBJS  *  v_vector.obj  v_iiiatrix.obj  v_quat.obJ  v_rvb«r.obj  \ 
v_inSO.^j  vJ2000.obj  v_cbeck.obj 

SWAP_OBJS  =  swap_d.obj  swap_f.obj  sw^>_s.obj 

EMM_OBJS  »  einin_lowa.obj  eiiuii_cotu.obj  emm  map.obj  enun  mapin.obj 
!if  $d(GPS) 

NPS_OBJS_GPS  =  ops_iii50.obj  dif_daU.obj  dif_piot.obj  \ 
nps_iilt.obj  Isiilter.obj  nps_dap.obj  nps_pred.obj 
!eudif 

NPS  OBJS  =  nps.obj  nps_edit.obj  nps_plot.obj  menupiot.obj  \ 
rv_d*ta.obj  rv_plot.obj  py_daU.obj  py_plot.obj  \ 
f_and _g.obj  plane.obj  nps_dap.obj  nps_pred.obj  $(NPS_OBJS_GPS) 

ORB_PKT_OBJ  =  orb_pkt.obj 
ORB_PORT_OBJ  =  orb_port.obj 
ORB_nLE,  OBJ  =  orb_file.obj 

TANS  PKT2_OBJ  =  tanspkt2.obj 
TANS”PKT_OBJ  =  tans_pkt.obj 
TANS  PORT  OBJ  =  tansport.obj 
TANS^HLEJoBJ  =  Umsfile.obj 

TANS_nLE_SIM_OBJ  =  tnsprtsm.obj 
TANS~PORf_SPDRV_OBJ  =  tosprtfa.obj 

COM_OBJS  =  coin_intc.obj  coni_inta.obj 

TANS_OBJS  =  tansSl.obj  tiis_io_f.obj  pfx;_tpkt.obj  tans_sys.obj  tanstime.obj  \ 
almanac.obj  mSO_eph.obj  display.obj  main  dis.obj  par8_dis.obj  iiiisc_di5.obj  \ 
n]ap_dis.obj  spc_edit.obj  ni(sc_fun.obj  log.obj  exit.obj 
TANS_NPS_FAKE  =  nps_fake.obj 

#  TANS,  with  NPS  *****  STS-51  Right  Version  ***** 

# 

TANS51_OBJS  =  $(TANS_OBJS)  npsjf.obj  $(NPS  OBJS)  \ 

$(ORBJ>KT_OBJ)  $(OR^  PORT_OBJ)  $(TANS_iR)RT_OBJ)  $(C0M_0BJS)  \ 
$(VECTOR_OBJS)  $(TIME_OBJS)  $(EDIT_RT_OBJS)  $(ORBMECH_OBJS)  $(EMM_OBJS) 

TANS51_IJBS  =  $(GRAPHLIB)  $(MATHLIB)  $(CUB) 

tans.exe::  turboc.cfg 
tans.exe::  $(TANS51_OBJS) 

$(LD)  $(LFLAGS)  /L$(UBPATH)  ®&&.\ 
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$(C0)  $■*■*,$  <„$(TANS51_UBS) 

j 

®$(TJS_DBUG)  /la  $< 

$(RM)  S'",  map 

#  TANSSl.  with  NFS.  Sim  from  file 

# 

TANS51SM  OBJS  =  $(TANS_OBIS)  nps  if.obj  $(NPS  OBJS)  \ 

$(ORB  PCT  OBJ)  $(ORB  FILE  OBJ)  S^ANS  nLE_OBJ)  $(COM_OBJS)  \ 
$(VECTOR_OBJS)  $(nME_OBJS)  $(EDIT_RT~OBJS)  $(ORBMECH_OBJS)  $(EMM_OBJS) 

TANSSl SM_UBS  =  $(GRAPHUB)  $(MATHUB)  $(CUB) 

tansSlsm.exe::  turboc.cfg 
tansSlsm.exe:;  $(TANSSlSM_OBJS) 

$(LD)  $(LFLAGS)  /L$(UBPATH)  @&&1 
$(€0)  $**,$< ,  .$(TANS5 1 SM  UBS) 

I 

@$(TJS_DBUG)  /la  $< 

$(RM)  S’*,  map 


#  TANSSl,  no  NPS,  with  SPDRIVE 

n 

TANS  SPDRV_OBJS  =  $(TANS_OBJS)  $(TANS_NPS_FAKE)  $(TANS_PORT_SPDRV_OBJ)\ 
$(EDiT_0BJ^ 

TANS_SPDRV_UBS  =  $(GRAPHUB)  $(MATHUB)  $(CUB) 


tans  qxl.exe::  turboc.cfg 
tans~spd.exe::  $(TANS  SPDRV  OBJS) 
$(LD)  $(LFLAGS)  /UfUBPATO)  &&&\ 
$(C0)  $**,$<  „$(TANS_SPDRV  UBS) 

I 

®$(TJS_DBUG)  /la  $< 

$(RM)  $*.m^i 


#  TANSSl,  no  NPS 

# 

TANSSl FN  OBJS  =  $(TANS_OBJS)  $(TANS  NPS_FAKE)  \ 
$(TANS_roRT  OBI)  $(EDIT_OBJS)  $(C0M"  OBJS) 

0  $(TANS_PORf_SPDRV_OBJ) 

TANSSl FN_UBS  -  ${GRAPHUB)  $(MATHUB)  $(CUB) 


aak«£ile 
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tans51fe.exe::  turboc.cfg 
tansSlfti.exe::  $aANSSlFN_OBJS) 
$(LD)  $(LFLAGS)  /Ua^BPAIH) 
$(C0)$**$<„$(TANS51FN  UBS) 

I 

0$(TJS_DBUG)  /la  $< 

$(RM)  S^.map 


#  TANS  device  simulator 

# 

TSIM_OB)S  =  tsim.obj  tsim_pkt.obj  \ 
tsiffl_2x.obj  tsim  3x.obj  tsim_5x.obj  tsim_ex.obj  \ 
$(TANS_PORT_bBJ)  $(COM_OBJS)  $(EDIT_OBJS)  ${SWAP_OBJS) 

TSIM_UBS  =  $(MATHUB)  $(CUB) 

tsim.exe::  turboc.cfg 
tsim.exe::  $(TSIM_OBJS) 

$(U>)  $(LPLAGS)  /L$(UBPATH)  &&A.\ 

$(CX))  $**,$<  „$(TSIM  UBS) 

I 

®$(TJS_DBUG)  /la  $< 

$(RM)  $''‘.map 


#  TANS  data-file  dumper 

# 

TANSDUMP_OBJS  «  tansdump.obj  \ 
$(TANS_PKT_OBJ)  $(SWAP_OBJS)  $(EDIT_OBJS) 

TANSDUMP_UBS  =  $(MATHUB)  $(CUB) 

tansdun^.exe::  turboc.cfg 
tansdump.exe::  $(TANSDUMP_OBJS) 

$(U>)  $(U1JVGS)  /L$(UBPATH)  ®&&| 

KCO)  $■**  $<„$(TANSDUMP  UBS) 

I 

®$(TJS_DBUG)  /la  $< 

$(RM)  $*.map 


#  TANS  data-file  vector  dumper 

# 

TANS_VEC_OBIS  »  tans  vec.obj  \ 

$(TANS  PKT  OBJ)  $(SWAP  OBIS)  $(EDIT  OBIS) 


a«k«£lle 


a«k«fll« 


TANS_V1C_LIBS  «  KMATHUB)  $(C1JB) 


Uu)s_vec.exe::  turboc.cfg 
tans  vec.exe::  $(TANS  VEC  OBIS) 
$(LD)  $(LFLAGS)  /UOJBPATH) 
$(a))$**$<.,$(TANS  VEC_liBS) 

I 

®$(TJS_DBUG)  /la  $< 

$(RM) 


#  TANS  data-file  state-vector  dunq>er 

# 

TANS  V2  OBJS  =  tans  v2.obj  \ 

$(TANS  l»KT2_OBJ)  $(TANS_PKT_OBJ)  $(SWAP_OBIS)  $(EDIT_OBJS)  $(TIME_OBJS) 

TANS_V2_UBS  «  $(MATHUB)  $(CUB) 

tans_v2.exe::  turboc.cfg 
tans~v2,exe::  $(TANS  V2  OBJS) 

$(LD)  $(LFLAGS)  /L$(UBPATH) 

$(00)  $**,$<  „$(TANS_V2_UBS) 

j 

®$(TJS_DBUG)  /la  $< 

$(RM)  $*.nu4> 


#  Com-port  two-way  tester  (via  built-in  interrupt  buffers) 

#  Run  this  program  on  two  machines  simultaneously 

# 

COM_TXRX_OBJS  =  com_txrx.obj  $(EDIT_OBJS)  com_intc.obj  com_inta.obj 

C0M_TXRX_UBS  *  $(CUB) 

com_txrx.exe::  turboc.cfg 

com  txrx.exe::  $(COM  TXRX  OBJS) 

$(U))  $(LFLAGS)  /L$(UBPATH)  &&&\ 

KCO)  $*•,$< „$(COM  TXRX  UBS) 

I 

®$(TIS  DBUG)  /U  $< 

$(RM)  $*.map 


#  Com-port  tester  (via  built-in  interrupt  buffers) 

TEST_COM_OBIS  b  test_com.obj  $(EDIT_OBIS)  com_intc.obj  com_inta.obj 


aak«£il« 


TEST_COM_LIBS  «  $(CUB) 

test_coin.exe::  tuitoc.cfg 
test  coin.exe::  $(TEST  COM  OBIS) 
$dl>)  $(LFLAGS)  /l^BPAIH) 

$(C0)  $•*  $<„$(TEST  COM  UBS) 

I 

0$(nS_DBUG)  /u  $< 

$(RM)$*inap 

#  Com-port  tester  (via  DOS  device  driver) 

TEST_DEV_OBJS  =  test_dev.obj 

TEST_DEV_UBS  =  $(CUB) 

test_dev.exe::  turboc.cfg 

test  dev.exe::  $(TEST  DEV  OBJS) 

$^)  SCU’LAGS)  /U(UBPATH) 

$(C0)  $**.$<..$(TEST_DEV_UBS) 

®$(TJS_DBUG)  /la  $< 

$(RM)  $*.iiiap 


#  Packet  file  filter/cleaner 

# 

PKT_CLN_OBJS  *=  i*t_clii.obj  $(ORB_PKT_OBI)  SdlME.OBJS)  $(VECTOR_OBJS) 

PKT_CLN_UBS  -  $(MATOUB)  $(CUB) 

pkt  cin.exe::  turboc.cfg 
pkt~cln.exe::  $(PKT  CLN  OBIS) 

$^)  $(m.AGS)~/L$(UBPATH)  ®&&| 

$(O0)$**$<„$(PICT_CU4  UBS) 

I 

®$(TIS_DBUG)  /U  $< 

$(RM)  $*.nup 


#  Pkdcet  file  duoqper 

# 

PKT_SHOW_OBJS  «  idct_8iiow.obj  $(ORB_PKT_OBJ)  $(nME_OBJS)  $(VECTOR_OBJS) 
PKT_SHOW_UBS  *  SCMATHUB)  $(CUB) 


■ak«£lltt 


pkt  show.exe::  turboc.cfg 
pkt~iiiow.exe::  $<PKT  SHOW  OBJS) 
$(1d)  $(LFLAGS)  /LSCUBPATH)  0&&I 
$(C0)  $•*,$<  „$(PKT  SHOW  UBS) 

I 

«$(TJS  DBUG)  /U  $< 

$(RM)  $*  iiU4> 


#  Vector  functions  tester 

# 

TEST_VEC_OBIS  =  test_vec.obj  vect_old.obj  $(VECTOR_OBJS)  $(ORBMECH_OBJS) 
TEST_VEC_UBS  =  $(MATHUB)  $(CUB) 


test_vec.exe::  turboc.cfg 
test_vec.exe::  $(TEST  VEC  OBJS) 
$(U>)  $(U^LAGS)  /L$(UB^PATH) 
$(C»)  $*♦,$<. ,$(T^_VEC_UBS) 

j  ~  ~ 

®$(TJS_DBUG)  /la  $< 

$(RM)  S^.map 


#= 


#  EMM  functions  tester 

# 

EMM_TEST_OBJS  =  einin_test.obj  $(EMM_OBIS) 

EMM_TEST_UBS  *  $(MATHUB)  $(CUB) 

enun_test.exe::  turboc.cfg 
enun_test.exe::  $(EMM  TEST_OBJS) 

$(U))  $(LFLAGS)  /licUBPATH)  ®&&| 

$(C0)  $*♦,$<  „$(EMM_TEST_UBS) 

I 

®$(TJS_DBUG)  /U  $< 

$(RM)  S^.nup 


#  Map-file  converter,  text  to  raw 

# 

MAP_RAW_OBIS  ■  map_raw.obj 

MAP_RAW_UBS  «  $(MATHUB)  $(CUB) 

inq>_raw.exe::  turboc.cfg 
niap_raw.exe::  $(MAP_RAW_OBIS) 

makefile 


makefile 


$(LD)  $(LFLAGS)  /UdJBPATH) 
$(C»)  $**,$<. .$(MAP  RAW  UBS) 

I 

0$(nS_DBUG)  /la  $< 

$(RM)  $*.iiiap 


#  Video-mode  switcher 

# 

VMODE_OBJS  -  vmode.obj 

VMODE_UBS  =  $(CUB) 

vmode.exe::  turboc.cfg 
viDode.exe::  $(VMODE  OBIS) 
$(U>)  SOFLAGS)  /L$(UBPATH) 
$(C»)  $**.$<..$(VMODE_UBS) 

1 

0$(TJS_DBUG)  /la  $< 

$(RM)  $'*'.niap 


#  NPS  Stand-alone,  input  from  com-port  (built-in) 

# 

NPSX.OBIS  «  nps  main.obj  scom.obj  $(NPS  OBIS)  \ 

$(ORB  PKT  OBI)  $(ORB  PORT  OBI)  $(CdM  OBIS)  \ 

$(VECTOR_OBJS)  $(nME_OBIS)  $(EDrr_RT“OBIS)  $(ORBMECH_OBIS)  $(EMM_OBIS) 
NPSX_UBS  =  $(GRAPHUB)  $(MATHUB)  $(CUB) 


nps.exe:;  turboc.cfg 
nps.exe::  $(NPSX  OBIS) 

$(U))  $(LFLAGS)  /L$(UBPATH)  @&&\ 
$(<»)$♦•  $<„$(NPSX  UBS) 

I 

0$(TIS_DBUG)  /la  $< 

$(RM)  $*.map 


#= 


#  NPS  Simulator,  input  from  com-port  (built-in),  no  data  output 

# 

SCX>M  OBIS  s  sim.obj  scom.obj  gnoiie.obj  $(NPS_OBIS)  \ 

$(aRB  PKT  OBJ)  $(ORB  PORT  OBI)  $(COM  OBIS)  \ 

KVECTORJoBJS)  $CnMi_OBIS)  $(EDIT_RT_0BIS)  $(0RBMECH_0BIS)  $(EMM_0BIS) 
SCOM_UBS  «  $(GRAPHUB)  $(MATHUB)  $(CUB) 


■ak«£ll« 
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scom.exe::  turboc.cfg 
scoin.exe::  $(SCOM  OBJS) 

$(LD)  $(LFLAGSr/L$(UBPATH) 
$(C0)  $♦*,$<  „$(SCOM  UBS) 

I 

0$(TJS_DBUG)  /U  $< 

$(RM)  $'*'.niiq;> 


#  NPS  Simulator,  input  from  com-port  (DOS  device  driver),  no  data  output 

# 

SDEV_OBJS  «  sim.obj  acom.obj  gnooe.obj  $(NPS  OBIS)  \ 

$(ORB_PKT  OBI)  $(ORB  HLE.OBI)  \ 

$(VECTOR_bBJS)  $(nME_OBIS)  $(EDIT_RT_OBJS)  $(ORBMECH_OBJS)  $(EMM_OBJS) 

SDEV  UBS  =:  $(GRAPHUB)  $(MATHUB)  $(CUB) 

sdev.exe::  turboc.cfg 
sdev.exe::  $(SDEV  OBJS) 

$(U))  SCmAGS)  /L$(UBPATH) 

$(C0)  $**,$<  „$(SDEV  UBS) 

I 

@$(TJS_DBUG)  /la  $< 

$(RM)  S^.inap 


#  NPS  Simulator,  input  from  com-port  (DOS  device  driver),  no  data  output 

# 

!if$d(GPS) 

SDEV_DLY_OBJS_GPS  *  $(TANS_PKT2_OBJ)  $(TANS_PKT_OBJ)  $(TANS_nLE_OBJ)  $(SWAP_OBJS) 
lendif 


SDEV_DLY  OBJS  s  sim.obj  scorn  dly.obj  timer.obj  gnooe.obj  $(NPS  OBJS)  \ 

$(ORB_PkT  OBJ)  $(ORB  RLE_6bJ)  $(SDEV_DLY  OBJS  GPS)  \  ” 

$(VECrOR_bBJS)  $CnME_OBJS)  $(EDIT_RT_OBIs3  $(0RBMECH_0BIS)  $(EMM_0BJS) 

SDEV_DLY_UBS  =  $(GRAPHUB)  $(MATHUB)  $(CUB) 


adev  dly.exe::  turboc.cfg 
8dev~dly.exe::  $(SDEV  DLY  OBJS) 
$(Lb)  $(LFLAGS)  /lifUBPATH) 
$((»)  $*•,$<  „$(SDEV  DLY  UBS) 

I 

®$(TJS_DBUG)  /la  $< 

$(RM)  $*.map 


aak«£il« 


#  NPS  Simulator,  input  from  propagator,  no  data  output 

# 

Sn(P  OBIS  *  aim-obj  sprop.obj  timer.obj  gnone.obj  $(NPS  OBIS)  \ 

$(VicTOR_OBJS)  $(nME_OBJS)  $(EDIT_RT_OBJS)  $(6rBMECH_OBJS)  $(EMM_0BJS) 

SPRP_UBS  «  $(GRAPH1JB)  $(MA1WJB)  $(CUB) 

sprp.exe::  turboc.cfg 
aprp.exe::  $(SniP  OBIS) 

$(LD)  $(LFLAGS)  /L$(UBPATH)  OA&i 
$(C0)  $♦*,$<  „$(SPRP  UBS) 

I 

0$(TIS_DBUG)  /U  $< 

$(RM)  $*.map 


#  NPS  Simulator,  input  from  disk,  no  data  output 

# 


SDSK  OBIS  —  sim.obj  sdisk.obj  timer.obj  gnone.obj  $(NPS_OBIS)  \ 

$(VECTOR_OBIS)  $(nME_OBJS)  $(EDIT_RT_OBIS)  $(ORBMECH_OBIS)  $(EMM_OBJS) 


SDSK_UBS  »  $(GRAPHUB)  $(MATHUB)  $(CUB) 


sdsk.exe::  turboc.cfg 
8dsk.exe::  $(SDSK  OBIS) 

$(U>)  $(LFLAG^  /UOJBPATH)  &&&\ 
$(C0)  $*•,$<  „$(SDSK  UBS) 


®$(TJS_DBUG)  /U  $< 
$(RM)  $*.map 


#  NPS  Simulator,  input  from  memoiy  (from  disk),  no  data  output 

# 


SMEM_OBJS  »  sim.obj  smem.obj  gnone.obj  $(NPS_OBIS)  \ 

$(VECTOR_OBJS)  $CnME_OBIS)  $(EDIT_RT_OBIS)  $(ORBMECH_OBJS)  $(EMM_OBIS) 


SMEM_UBS  B  $(GRAPHUB)  $(MATHUB)  $(CUB) 


smem.exe::  turboc.cfg 
sinem.exe::  $(SMEM  OBIS) 

$(U>)  $(mj^GS)  ^(UBPATH)  0&&I 
$(0))  $**,$<  „$(SMEM_UBS) 


0$(nS_DBUG)  /U  $< 
$(R^  $*.map 


Bak«£ll« 
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#  NPS  Generator,  input  from  propagator,  output  to  disk 


# 

PRP_DSK_OBJS  B  sim.obj  qnop.oty  timer.<^  gdisk.obj  nps  none.obj  nps  mSO.obj  \ 
$C^Cim_OBJS)  $(TIME_OBIS)  $(EDIT_RT_OBJS)  $(OMMECH_OBJs) 

PRP_DSK_LJBS  «  $(GRAPHUB)  $(MA’mUB)  $(CIJB) 


prp  dak.exe::  turboc.cfg 
prp'dsk.exe::  $(nu>  DSK  OBJS) 

$dX»  $(LFLAGS)7U(UBPATH)  ^Sl8l\ 
$(C0)  $**,$<  „$(PRP  DSK_UBS) 

I 

®$(TJS  DBUG)  /la  $< 

$(RM)  $*.inap 


#  NPS  Generator,  input  from  propagator,  output  to  corn-port  (DOS  device  driver) 

# 

PRP  DEV  OBJS  =  sim.obj  sprop.obj  timer.obj  gcom_dev.obj  nps  none.obj  nps  mSO.obj  V 
$(VECT6r_OBIS)  SCTIME^OBIS)  $(EDIT_RT_0BJS)  $(0RBMECH_0BJS) 

PRP_DEV_UBS  =  $(GRAPHUB)  $(MATHUB)  $(CLIB) 

prp_dev.exe::  turboc.cfg 

prp  dev.exe::  SOWP  DEV  OBJS) 

$(LD)  $(LFLAGS)7U(LrBPATH)  ®&&| 

$(00)  $•*,$<  „$(PRP  DEV  UBS) 

1 

®$(TJS_DBUG)  /la  $< 

$(RM)  $*.map 

#  NPS  Generator,  input  from  propagator,  output  to  corn-port  (built-in) 

# 

PRP  COM_OBJS  s:  sim.obj  sprop.obj  timer.obj  gcom_com.obj  nps  none.obj  nps  mSO.obj  \ 
$(COM_OBJS)  $(VECTOR_OBJS)  $fnME_OBJS)  $(EDIT_RT_OBJS)  $(ORBMECH_OBJS) 

HlP_COM_UBS  *  $(GRAPHUB)  $(MATHUB)  $(CUB) 

prp_com.exe::  turboc.cfg 

prp  com.exe::  $(niP  COM  OBJS) 

$dj»  $(U^GS)  ^(UBPATH) 

$(O0)  $♦♦,$<  „$(PRP  COM  UBS) 

I 

®$(TJS_DBUG)  /la  $< 

$(R^  $*.map 


makefile 


#  Compiler  ccmfigunUioa  file 

# 

###  -ml  -1  $(CDEBUG)  -02  -Ff  -f287  -wdef  -wood  -wpro  -wuse 
turboc.cfg:  makefile 
copy 

-ml  -1  $(CDEBUG)  $(CEXTRA)  -Ff  -wdef  -wood  -wpro  -wuae 
-ISaNCPATH)  -UdJBPATH)  -n$(.path.obj) 

I  turboc.cfg 

#  Gotpot.c  needs  special  compile:  no  optimization 

# 

gotpot.obj:  orbmechlXgotpot.c 
$(CC)  -c  -02-V  $? 


■ak«£lle 


